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Part I 


The Design and Stability of Boats: 
Multivariable Calculus and Mechanics 


Chapter 1 


Week 1a: Welcome back, Question 
decomposition, and Vector Operations 





Schedule 
1.1 Welcome back! [15 mins] ........0. 0.0.2 eee ee ee te ee ns 3 
1.2 Question Decomposition and Concept Map [3omin] ...............4. 3 
i531 Decomposing the Beat... 4.5 ee ee ed Ee ee a ee ee 3 
1.3 Vectors and Vector Operations: Cartesian[go min] ................4. 4 
13.1 Conceptual Questions about Vectors... 6 ee ees 5 





1.1 Welcome back! [15 mins] 


Let’s spend a few minutes catching up, looking back to last semester, and looking forward to this semester. 


1.2 Question Decomposition and Concept Map [30 min] 


We want to spend a little time here thinking about the process you go through when faced with an engineering 
challenge: what choices do you make when, and why? You decide what kinds of creating, measuring, and 
calculating to do based on implicit or explicit questions that you are trying to answer. Thus, deciding what 
the questions are, and identifying strategies for answering these questions, is a critical part of being effective 
in analysis. 


1.2.1 Decomposing the Boat 


We end this module by designing a boat that meets particular criteria, and you will validate your design 
both in simulation and in the real world. 

While it is often both possible and necessary to do some amount of “tinkering” when you design 
something, using the power tools of math and science in the design process is critical for most real world 
design problems. To that extent, you often need to figure out 1) how to turn an ambiguous real world 
problem into solvable questions and z) what knowledge you need to apply to the problem. 

To do this for our boat, we need to decompose the big, fuzzy question of “What should our boat design 
be?” into more concrete sub-questions. We’ve done some of that below. 
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What should my 
boat design be? 


My boat should My boat should be My boat should | need to be able 
float. able to tilt some not make to manufacture 
amount without someone seasick. my boat. 


tipping over. 





























Figure 1.1: Boat Question Decomposition 


Looking at these questions, we'd like you to start your boat project by thinking about part 2: how do the 
somewhat messy design criteria translate into concrete concepts. 


Exercise 1.1 


As a group, make a mind map showing what you need to know to ensure that you can meet each of 
the following boat design criteria: 


» My boat should float. 
+ My boat should not tip over with a certain range of angles of tilt. 


You already did one of these for eigenfaces at the end of the module; in this case we want you to 
some figuring out of what you need to learn, so that you have a framework to hang your learning on. 
Your mind map should include terms like those below (you don’t necessarily need to include all of 
them, but you certainly could!) and should also include lines that indicate the relationship between 
the terms (e.g., a line between “force” and “gravity” might be used to indicate that gravity is an 
example of a force). 


Here are some terms you might include: angle of vanishing stability , equilibrium, , vector, , torque 
, force , pressure , gravity , centroid , distributed force , point mass , equivalent point force , center of 
mass , center of buoyancy , dot product , cross product , statics , moment , waterline , righting moment 
curve, ballast , free body diagram , Volume integral , surface , explicit , implicit , drag , hydrostatic , & 
parametric 





Now that we have a map of what we plan to learn, let’s get down to business! 


1.3. Vectors and Vector Operations: Cartesian [40 min] 


One key set of concepts and tools for designing your boat (and engineering projects in general) is vectors 
and vector operations. Many of the vectors we worked with in the first module were abstract, e.g. we treated 
day temperatures as a vector, or we treated an image as a vector. We are now going to turn out attention 
to physical vectors, that encode information like position, velocity, acceleration, force, torque, etc. In 
order to solve engineering problems, we need to manipulate these physical vectors, and thus we need to 
understand vectors and vector operations, including addition, scalar multiplication, dot products and cross 
products in three dimensional space as well as the more general n dimensional space that we worked in last 
semester. 

Video Review: A few years ago Mark got tired of giving the same lecture over and over again, and he 
put together a bunch of videos, which are available at this link for your reference to consult as you work 
through the exercises today. 
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1.3.1 Conceptual Questions about Vectors 


Exercise 1.2 


A vector has both a magnitude and a direction. Draw and label a vector to demonstrate what this 
means. 


Exercise 1.3 


Dot and Cross Products: What does the dot product of two vectors tell you about the two vectors? 
What about the cross product? Draw and label a picture of each to illustrate your point. 


Exercise 1.4 


Geometrical Vectors: The diagram shows three vectors, A, B, and C. All three are in the plane of 
the page; their magnitudes are (respectively) 2, 1, and 3. For each operation below, draw the results of 
the identified operations, (if appropriate) give a best guess as to the value, or (if appropriate) identify 
the operation as nonsense. 


Exercise 1.5 


Calculating Cartesian Vectors: Let A= 30+ 4}, Ba=i- j, and C= -5 j. Make a coordinate 
plane, label your axes, and then draw each vector. Find the results of identified operations, or (if 
appropriate) identify the operation as nonsense. 


1. |A+B| 
rere ae 
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ee) 


Exercise 1.6 


Constructing Useful Vectors: It is often the case in modeling that you want to construct a unit 
vector that points in a particular direction relative to some other vectors: “I want a unit vector that is 
perpendicular to the deck of the boat”, or “The Magnus force is perpendicular to the rotational axis 
and the velocity”. There are some nifty tricks for constructing this kind of vector; this problem asks 
you to think through them. A and B are two arbitrary, non-parallel vectors in three-dimensional 
space. Using them, construct the following vectors (i.e., find mathematical expressions for the 


specified vector in terms of the vectors Aand B ): 


1. The vector A, which has a length of 1, and points in the direction of A 


2. The vector 7, which has a length of 1, and is perpendicular to both Aand B. 
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Solution 1.3 


Dot product tells you how parallel two vectors are. Cross product tells you how perpendicular two 
vectors are, and what the plane defined by these vectors are. 


Solution 1.4 
1A +B 
Vector addition is accomplished geometrically by drawing the vectors head-to tail. In this case, 


putting the tail of vector B at the head of vector A (or vice versa) will result in a vector longer 
than either A or B and pointed up and to the left. 


2, A-C 
Vector subtraction is accomplished geometrically by drawing the vectors head-to head. In 
this case, putting the head of vector C at the head of vector A will result in a vector pointed 
strongly to the left and only a little up. Alternatively, you can consider A-C as A+-C. Simply 
switch the head with the tail of C and then add the vectors head to tail as in the previous 
exercise. 

3. A.B 
The dot product is a scalar equal to the product of the magnitudes of the vectors times the 
cosine of the angle between them. In this case we know the magnitudes (2 and 1) but don’t 
know the angle, though we could estimate it as maybe 60 degrees. 


4. (Ax B)x GE 
(A x B) will give you a vector pointing into the page with magnitude 2 * sin 6. Crossing this 
with C will result in a vector back in the plane of the page and pointing down with magnitude 
6 * sind. 


5. (A.B) x 
This one is nonsense because the dot product results as a scalar, as you can’t cross a scalar 
with a vector. (Like the joke: what do you get when you cross a mosquito with a mountain 
climber?? Nothing! You can’t cross a vector with a scalar!) 


Solution 1.5 
1. |A+B 
ei) 
Laue 
—15k 
3. A.B 
-1 
Solution 1.6 
1. The vector A, which has a length of 1, and points in the direction of A. 
A/|Al 
2. The vector 7, which has a length of 1, and is perpendicular to both A and B. 
tA x B/|A x Bl 





Chapter 2 


Week 1b: Forces and Free Body 
Diagrams 





Schedule 
2.1 Force Concepts [40min] .... 0.5.6 500 eee eet eee eee eee eee 8 
2.2 Free Body Diagrams[go min] .. 1... 0.0... ce ee ee eee 10 





2.1 Force Concepts [40 min] 


During the overnight you watched several videos that covered topics in vector operations and types of forces. 
Some of these topics may have been new to you, and some may have been review, but they are all valuable 
for the upcoming material in the course. 

Please work through the following exercises to debrief, synthesize and then build on the forces material 
you encountered in the overnight. 


Exercise 2.1 
May the Forces be With You [10 min] 


1. With your group, review the tables you made highlighting important topics modeling forces. 
Are there any concepts you are still confused about? If so, work with your group to resolve 
these confusions. 


. The videos you watched identified several types of forces. With your group, search online to 
find a picture in which you think that a number of these forces are being exerted. Paste this 
picture into your miro board, discuss the types of forces involved, and draw and label vectors 
on the diagram to indicate what the forces are and where they act. 


. For the forces identified in the previous question, is there an equation that is used to model 
the force? If so, write it next to your drawing. What are the unknowns in your equations? Are 
there simple experiments you can do to characterize the forces? 


Exercise 2.2 


Force Concepts [20 min] Discuss and agree upon answers to these questions - including the “why”! 





11 
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. “Iam pushing a coffee cup across my desk. Since it is in motion, I know that the magnitude of 
the frictional force acting on the cup is given by juz.N, where juz is the coefficient of kinetic 
friction and N is the normal force the table exerts on the cup.” True or false? Why? 


. ‘Tam pushing on a coffee cup that is sitting on my desk. Since it is not moving, I know that the 
magnitude of the frictional force acting on the cup is given by j1,.N, where j1, is the coefficient 
of static friction and N is the normal force the table exerts on the cup.” True or false? Why? 
(Think carefully about this one!) 


. If an object of mass m is sitting alone and stationary on a level surface, what is the magnitude 
of the normal force that the surface exerts on the object? Why? 


. Now consider that we drop this object onto the surface. During the time that the object is 
decelerating to a stop when it comes into contact with the surface is the normal force exerted 
by the surface on the object greater than, less than, or equal to the force from part c? Why? 


. Why does a boat actually float at a given level? Write an explanation invoking the concepts of 
hydrostatic pressure, gravity, and distributed forces. It would probably be helpful to make a 
few cross-sectional sketches of the boat: maybe one of the boat that is not at equilibrium, and 
one where the boat is at equilibrium. Your sketches should include a bunch of small arrows 
that indicate the distributed forces acting on the boat, as well as any equivalent discrete forces 
(e.g., gravity) acting at the appropriate point(s) on the boat. 


Exercise 2.3 


Calculating Forces [10 minutes] The total force acting on an object is the sum of all the different 
force vectors acting on that object.. 


1. A man is pulling a rope running between points A and B with a force of 70 lbs. Describe 
the force of the rope on his hand as a vector in terms of components aligned with the x-y-z 
coordinate system shown. 
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2.2 Free Body Diagrams[4o min] 


For just about any design we make - boats, bridges, robot grippers - we need to be able to understand the 
system requirements and what forces are interacting with our system. Free body diagrams may or may not 
be new to you, but they are powerful! 

Watch the first video ("Concept and Overview Example") under Section 3, "Free Body Diagrams,” here. 


Exercise 2.4 
Qualitative FBDs 


1. Consider a sprinter who is running (and accelerating) over a level surface. With your group, 
draw a free body diagram for the person (assume one of the person’s feet is in contact with 
the ground). Use appropriately directed arrows, in appropriate places, and of appropriate sizes 
to indicate the forces acting on the person. Make sure to label the arrows appropriately. What 
force is propelling the runner forward? 


. Consider a hot air balloon carrying a basket with two riders. It is floating at a given altitude. 
Draw free body diagrams for the following: 
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(a) Draw a FBD for the whole system (balloon + basket) using equivalent forces to represent 
all distributed (body and contact) forces (for example, consider the buoyancy of the 
balloon to be a single force acting on the center of buoyancy). 


(b) Draw an FBD for the basket using equivalent forces to represent all distributed forces. 
(c) Draw a FBD for the balloon (not including the basket) using distributed forces. 


(d) Thinking back to our design and engineering questions, comment on the utility of each 
of these FBDs: what questions would each help you to answer? 


3. (optional) Find another picture from the internet that lends itself to multiple definitions of 
system boundaries, as the balloon example above does. Paste it into the miro board, and then 
draw free body diagrams for two different system boundary definitions that are potentially 
useful. Comment on the utility of the choices you made. 
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Solution 2.2 


Force Concepts 


1. 


“Iam pushing a coffee cup across my desk. Since it is in motion, I know that the magnitude of 
the frictional force acting on the cup is given by ju;.N, where ju, is the coefficient of kinetic 
friction and N is the normal force the table exerts on the cup.” True or false? Why? 

True. F = ppN 


. “Iam pushing on a coffee cup that is sitting on my desk. Since it is not moving, I know that the 


magnitude of the frictional force acting on the cup is given by ws, where ju, is the coefficient 
of static friction and N is the normal force the table exerts on the cup.” True or false? Why? 
(Think carefully about this one!) 

False. The quantity 4, is the LIMIT of the static friction force. Static friction is a constraint 
force which takes whatever value it needs to take in order keep the object stationary. Once 
that value exceeds the limit, the object will move 


. If an object of mass m is sitting alone and stationary on a level surface, what is the magnitude 


of the normal force that the surface exerts on the object? 
mg 


. Now consider that we drop this object onto the surface. During the time that the object is 


decelerating to a stop when it comes into contact with the surface is the normal force exerted 
by the surface on the object greater than, less than, or equal to the force from part c? 
Greater than: the surface has to not only support the weight of the object, but exert the 
force necessary to decelerate the object as well. Think about placing a rock on your hand vs. 
dropping a rock on your hand. 


. Why does a boat actually float at a given level? Write an explanation invoking the concepts of 


hydro-static pressure, gravity, and distributed forces. It would probably be helpful to make a 
few cross-sectional sketches of the boat: maybe one of the boat that is not at equilibrium, and 
one where the boat is at equilibrium. Your sketches should include a bunch of small arrows 
that indicate the distributed forces acting on the boat, as well as any equivalent discrete forces 
(e.g., gravity) acting at the appropriate point(s) on the boat. 

When the boat is floating in equilibrium, there are two equal and opposite forces: gravity and 
buoyancy, the latter of which is caused by hydro-static pressure where the boat contacts water. 
When the boat is too far out of the water, the total distributed force from hydro-static pressure 
(i.e, buoyancy) is not as great as the force of gravity, causing the boat to sink down until the 
buoyancy force matches the gravitational force. We expect a drawing with hydro-static force 
arrows pointing normal to and into the boat hull where it contacts the water and a downward 
gravitational force arrow acting on the middle of the boat. (If you were feeling fancy, you 
could have also included a distributed force from the air pressure above the boat—a force we 
often neglect. 


Solution 2.3 


. The unit vector that describes the direction of the rope (pointing away from the man’s hand) 


is (—10, 1, 12)/1/245. The force is in the same direction with magnitude 70 lb. So the force 
vector is 70 * (—10, 1, 12)//245 lb or (—44.7, 4.47, 53.7) Ib. 


Solution 2.4 


Please see diagrams at the end of the page. 

2d) Comment on the utility of each of these FBDs: what questions would each help you to answer? 
The full system FBD (part a) could help you solve the necessary buoyant force to maintain a constant 
elevation (static equilibrium) or rise/fall. With this knowledge, the size of the balloon can be chosen. 
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The basket diagram (part b) can help spec the cable attachments between the balloon and basket to 
prevent failure. The final diagram (part c) can help spec cables, or could help choose the material 
properties of the balloon itself to prevent failure of the canopy material. 
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Chapter 3 


Homework 1: Forces and Vector 
Operations 
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Please do the Video Review section (about 1 hour of work) before class on Wednesday—the 
rest of the homework is due as usual 


3.1 Video Review: Force Ideas and Models - Please complete for 
Wednesday! 


In previous exposures to physics content you may have been introduced to various types of forces and force 
models. Two of the fundamental big-picture takeaways about forces are: 


« Force is always a vector, and in order to fully specify the force, you need to give both magnitude and 
direction. 


« Forces must be added vectorially. 


Please complete exercise 3.1 for Wednesday. The rest of the homework is due Monday as usual. 


Exercise 3.1 


Video Review: Hooray, more videos! Like Vectors and Vector Operations, these may or may not be 
new ideas for you, but these concepts will be important throughout the course. Visit this link, and 
watch the videos relating to Models for Forces. This should take you about an hour if you watch it at 
regular speed and watch everything, or maybe 30 minutes if you watch at 2x speed. Which ever you 
choose to do, please complete the following table by listing the important ideas in the videos. 


| Ideas in the videos I already knew | Ideas in the videos I had not seen before | 
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3.2 Vector Operations 


Exercise 3.2 
Make a sketch of the system consisting of the inner solar system. Set the origin on the sun and 
assume the sun is stationary. Include Mercury, Venus, Earth, and the Earth’s moon (no need to be to 
scale here), and assume that everything is in the plane. 
Sketch the following position vectors: 


« The displacement vectors of all three planets from the sun (call these M ; V, and E) 


¢ The displacement vector of the moon from the earth (label this 77). 
With these definitions in place, sketch and find expressions (just in terms of M 5 V, and so forth) for: 
* The displacement vector pointing from the Earth to Venus 
+ A unit vector pointing from Mercury to the sun 
+ A unit vector pointing from Venus to the moon 


+ A unit vector that is perpendicular to the orbital plane of the earth 





CHAPTER 3. HOMEWORK 1: FORCES AND VECTOR OPERATIONS 19 


3-3 Modeling and Manipulating Forces 


Exercise 3.3 


1. Two forces are applied to an eye hook. They lie in the plane of the page with the orientation 
and magnitudes as shown. Determine the orientation and magnitude of the sum of these two 
forces acting on the hook. 


800n) 


5 105 
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Exercise 3.4 


In order to save us all from a horrible fate involving radioactivity, genetically-engineered super bugs, 
and bad script writing, Superman must push a car off a cliff. 





The car’s emergency brake is engaged, which might make things harder. But since he’s super, he’s 
able to push against the back of the car as hard as he wants to. So he chooses to apply a force that 
increases linearly in time. As he reaches the cliff, the force he is applying happens to be Mearg. 
Let’s call the interaction that the car experiences with Superman’s hands F's,,. What other interac- 
tions does the car experience during this time? Identify as many as you can. Then, using the axes 
below, sketch how the magnitude of each of these interactions changes in time. 


A 
F 


SM 
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Exercise 3.5 


The villain escaped. She hops her speedy getaway car, which looks like a poor drawing of a sedan 
but which is actually equipped with all sorts of really cool villain stuff, including a very powerful 
engine, and a top speed of 200 mph. She floors the accelerator, so initially her wheels spin and smoke 
(which looks cool, but probably increases her chance of being caught). And she keeps the accelerator 
pressed to the floor, and so she speeds away at ever-increasing speed (until, of course, she reaches 
200 mph). 

What interactions does the car experience during the time that she is getting away? identify them, 
and then sketch how each changes in time using the axes below. 


A 
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Exercise 3.6 


The Magnus force can be important for the motion of rotating bodies. You should be able to 
find a youtube video that demonstrates the Magnus force using paper cups (search for Curve Ball 
Demonstrator from the Exploratorium Teacher Institute, or follow this link. 

It’s a nifty demo, and easy to try out. It works even better if you use styrofoam cups (which are a bit 
lighter than paper). 


1. Write out/sketch the following: (1) a mathematical expression for the Magnus force, (2) a 
sketch of the trajectory of the cups in the demo, and (3) a set of free body diagrams that explain 
the motion. 


2. In the video as set up, the spin is counterclockwise, and the launch is to the right. How do 
things change if the spin is clockwise? Sketch and explain. 





CHAPTER 3. HOMEWORK 1: FORCES AND VECTOR OPERATIONS 23 


3-4 Free Body Diagrams 


In class, with the balloon problem, we started looking at different ways we can define the system boundaries 
for free body diagrams. For a more in depth look, watch the second video on Free Body Diagrams "System 
and subsystem boundaries" here. 


Exercise 3.7 


The diagram below shows three different conditions for a front-wheel drive car on a hill. 


wel 


Poa * 


Case 1: Parked Car, Emergency Brake on. Case 2: Car driving uphill at 30 mph. Case 1: Parked Car, Emergency Brake broke 
(starting to roll downhill). 


For each condition, draw free-body diagrams for the following systems: 


1. System = the entire car. 


2. System = the rear wheel of the car. 
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Exercise 3.8 


Draw free body diagrams for the following problems. 


1. The root educational robot uses two magnetic wheels to move around on a whiteboard. Draw 
a FBD for the root robot while a) Moving on a flat magnetic surface and b) on a vertical 
whiteboard. For simplicity, assume the robot is moving straight and accelerating. 


. Some robots such as the Hull Skater use magnetic wheels as well, but to stick to ships instead 
of whiteboards. Draw a new FBD for this robot when underwater. You can pick its orientation 
(maybe it’s upside down), but similarly assume it’s accelerating forward, and assume wheels 
are direct drive. 


3. How could do these FBDs impact your design choices for each robot? 


Exercise 3.9 


A chain, consisting of N links, each of mass m, hangs from the ceiling. Find an expression for the 
tension in the nth link in the chain (n = 1 for the chain that is attached to the ceiling; n = N for 
the lowest link in the chain). Hint: Consider plugging in some real numbers to check your answer. 
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Exercise 3.10 
The diagram below shows different cross-sections of a boat in water. For the purposes of this problem, 


make the following assumptions: 


« The boat is of uniform cross-section from stem to stern (i.e., it is a simple extrusion of the 
shape going into the page) 


- The boat has a uniform density of p, = 0.5 g/cm?. 


« The boat is 4 meters in length, has a beam of 1 meter, and is about 0.5 meters from the bottom 


of the hull to the deck (freeboard plus draft). 
- The water has a uniform density of p,, = 1 g/cm?. 
With those assumptions in mind, please do the following for each of the conditions drawn. 


. Calculate (approximately) the magnitudes of the gravitational force acting on the boat and the 
buoyant force acting in the boat. 


. Sketch (approximately) the locations of the center of mass and center of buoyancy of the boat. 
. Draw an appropriate free body diagram for each condition. 


. In words, describe how the boat would move for each condition (rise? Fall? Rotate clockwise? 
Rotate counter-clockwise? Remain stationary?) 
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Solution 3.1 


Please watch the videos and make your own table based on personal experience with the content. 


Solution 3.2 


Make a sketch of the system consisting of the inner solar system. Set the origin on the sun and 
assume the sun is stationary. Include Mercury, Venus, Earth, and the Earth’s moon (no need to be to 
scale here), and assume that everything is in the plane. 

Sketch the following position vectors: 


+ The displacement vectors of all three planets from the sun (call these M . V. and E) 
« The displacement vector of the moon from the earth (label this ™). 
With these definitions in place, sketch and find expressions (just in terms of M, V, and so forth) for: 


+ The displacement vector pointing from the Earth to Venus 
V-E 
« A unit vector pointing from Mercury to the sun 
_ 
|M| 
- A unit vector pointing from Venus to the moon 
=V4im, 
|E-V +m 


tye 





Solution 3.3 


The horizontal component of the resultant force would be 800 cos 40 — 600 cos 30 and the vertical 
component would be 800 sin 40 + 600 sin 30. Magnitude can be found from the square root of the 
sum of the squares of the two component. Angle can be found by taking the arc-tangent of the ratio, 
but it is also acceptable to just leave it in components. 


Solution 3.4 


Major interactions will be gravity, normal force, friction, and maybe drag. Friction will be static 
friction (brake is locked) until enough force is applied to break static friction, at which point it 
becomes kinetic friction. Normal force and friction stop once the car goes over the cliff. Drag will 
increase as the car’s speed increases (so it’s o until static friction is broken). Note that the solution 
sketch assumes a coefficient of static friction of around 0.5. 
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Solution 3.5 


Major interactions will be gravity, normal force, friction, and drag. Friction will start as kinetic (tires 
spinning) and then will become static. Note that the static friction that the car can exert on the 
ground is limited by the car’s ability to turn the tires - which depends on the motor, so I haven’t tried 
to represent that as anything other than a constant output. Normal force and gravity are constant 
and equal and opposite. Drag will increase as the car’s speed increases, and will asymptote as the car 
approaches its top speed so that the frictional force from the tires and the drag force balance. 
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Solution 3.6 


The Magnus force can be important for the motion of rotating bodies. You should be able to 
find a youtube video that demonstrates the Magnus force using paper cups (search for Curve Ball 
Demonstrator from the Exploratorium Teacher Institute, or follow this link. 

It’s a nifty demo, and easy to try out. It works even better if you use styrofoam cups (which are a bit 


lighter than paper). 


1. Write out/sketch the following: (1) a mathematical expression for the Magnus force, (2) a 
sketch of the trajectory of the cups in the demo, and (3) a set of free body diagrams that explain 
the motion. 


(a) Fi, = S(w x v) where F,,, is the Magnus force, S is air resistance coefficient, v is the 
velocity and w is the angular velocity. 


(b) The cup should make a loop-de-loop. 


(c) After the cup is released, spinning and traveling forward, the drag force on the ball will 
result in an overall Magnus force upward (you can check this with your Right Hand 
Rule). As the ball accelerates upward, the velocity vector changes; this will change the 
cross product and thus the Magnus force. This creates the loop-de-loop. See below for an 
example of a sketch. 
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2. In the video as set up, the spin is counterclockwise, and the launch is to the right. How do 
things change if the spin is clockwise? Sketch and explain. The cup will curve backwards. Now 
the Magnus force is pointing downward. As the cup accelerates downward and the velocity 
vector changes, the Magnus force will start to point backwards. 
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Solution 3.7 


The diagram below shows three different conditions for a front-wheel drive car on a hill. 


Case 1: Parked Car, Emergency Brake on. Case 2: Car driving uphill at 30 mph. Case 1: Parked Car, Emergency Brake broke 
(starting to roll downhill). 


For each condition, draw free-body diagrams for the following systems: 


1. System = the entire car. 


2. System = the rear wheel of the car. 


See example in figure. 


1. The stationary car should have mg going downward, normal forces at each of the tires, and a 
frictional force pointing along the incline acting on the front wheel. Accelerating up is the 
same, but the friction force on the front wheel should be larger, and there should be a frictional 
force on the back wheel pointing backwards. Rolling downhill, again is similar but now both 
frictional forces are pointing up the hill and they should be smaller than the x-component of 
mg. 


2. Rear wheel is similar but with mg/2 and one normal force. In the stationary and accelerating 
cases, there should be some force representing the force pulling on the axle (rather than friction 
from the front wheel) 


CHAPTER 3. HOMEWORK 1: FORCES AND VECTOR OPERATIONS 31 





‘a 
pe) 
2, 





Solution 3.8 


Draw free body diagrams for the following problems. 


1. The root educational robot uses two magnetic wheels to move around on a whiteboard. Draw 
a FBD for the root robot while a) Moving on a flat magnetic surface and b) on a vertical 
whiteboard. For simplicity, assume the robot is moving straight and accelerating a) mg and 
Fnagnets going down, normal force is equal to the sum of both, friction is going in the 
direction of motion. b) mg points down Fiagnets points into the wall, N is equal and opposite 
to Fmagnets, f is greater than mg and pointing up. 


2. Some robots such as the Hull Skater use magnetic wheels as well, but to stick to ships instead 
of whiteboards. Draw a new FBD for this robot when underwater. You can pick its orientation 
(maybe it’s upside down), but similarly assume it’s accelerating forward and wheels are direct 
drive. f is acting on both wheels in the direction of motion. mg goes down, Finag goes into 
the boat surface at each wheel. There should be some distributed buoyant force from the 
hydrostatic pressure. N is perpendicular to the boat surface and at each wheel. 


3. How could do these FBDs impact your design choices for each robot? For root and the Hull 
Skater, the friction force on the wall (or boat) must be larger than the weight of the robot and 
will determine the strength of the magnets and material of the wheels. 


Solution 3.9 


A chain, consisting of N links, each of mass m, hangs from the ceiling. Find an expression for the 
tension in the nth link in the chain (n = 1 for the chain that is attached to the ceiling; n = N for 
the lowest link in the chain). Hint: Consider plugging in some real numbers to check your answer. 
Since the chain is not moving, the sum of the forces is zero and tension in the chain must be equal to 
the force due to gravity from both the nth link and all the links below it. Therefore T = (N—n+1)mg 


Solution 3.10 


The diagram below shows different cross-sections of a boat in water. For the purposes of this problem, 
make the following assumptions: 
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* The boat is of uniform cross-section from stem to stern (i.e., it is a simple extrusion of the 


shape going into the page) 


- The boat has a uniform density of p, = 0.5 g/cm?. 


+ The boat is 4 meters in length, has a beam of 1 meter, and is about 0.5 meters from the bottom 


of the hull to the deck (freeboard plus draft). 


+ The water has a uniform density of p,, = 1 g/cm?. 


With those assumptions in mind, please do the following for each of the conditions drawn. 


1. 


2. 


3. 


4. 


Calculate (approximately) the magnitudes of the gravitational force acting on the boat and 
the buoyant force acting in the boat. The magnitude of the gravitational force is always the 
same. F, = p,V g = ppAlg. The cross sectional area can be approximated a few ways, most 
simply (though least accurately) as a rectangle with dimensions .5 m x 1m. Thus v = 2m? and 
F, = ppAlg = .5g/cm? * ae * —— * 2m? * 9.8m/s? = 9.8kN. The buoyant force Fg 
is the density of water multiplied by the submerged volume V,. Here we approximate V; as 


some fraction of the whole boat Vz 








Sketch (approximately) the locations of the center of mass and center of buoyancy of the boat. 


Draw an appropriate free body diagram for each condition. 


In words, describe how the boat would move for each condition (rise? Fall? Rotate clockwise? 
Rotate counter-clockwise? Remain stationary?) 


See diagram for numbering and FBDs. 


1. 


2. 


Fg is approximately eVBPw9 = 3.3kN. Fg < mg so the boat will fall. 


The submerged volume is about 1/4 of the boat. Following a similar line of calculation, 
Fp =4.9kN. Fg < mg and is not aligned so the boat will rotate counterclockwise (CCW) 
and sink slightly. 


Similar to(1), 2/3 of the boat is submerged, Fg is approximately 13.1 kN and is greater than 
mg, so the boat will rise. 


Fp = 14.7KN, the boat will rise and turn CCW. 


Fg = 19.6kN The boat will rise (and might even pop out of the water before settling at 
equilibrium). 


Fp = 9.8kN and equals mg. The boat will turn CW. 
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Chapter 4 


Week 2a: Torque and More Free Body 
Diagrams 
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4-3 Torque Practice [20 minutes] .. 2... ee 37 
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4.1 Introduction to Torque [25 minutes] 


Last week we worked on vectors, forces, and the idea of free body diagrams - and in creating free body 
diagrams, we encouraged you to draw a picture to represent the system, and to draw arrows at different 
locations to represent interactions (forces) between the system and the rest of the world. 

We encouraged you to draw the picture — as opposed to just a “dot”, which is often how FBD’s are 
drawn in introductory physics — because the location at which forces are applied matters. Consider the 
two conditions shown below. In both cases the net force is zero, but it seems pretty clear that the physical 
behavior will not be the same! 




















This qualitative example illustrate the idea of torque (denoted by the vector 7 or T). Just as a force is 
colloquially thought of as “the thing that causes acceleration”, a torque is “the thing that causes rotation”. In 
the first example above, the net torque acting on the pencil was zero - so no rotation occurs, while in the 
second case, there is a net torque on the pencil — so the pencil “wants” to rotate. 


A note about terminology: The terms torque and moment are often used interchangeably in engineering. 
In free body diagrams, moments are denoted using a curved arrow, like the example in Figure 4.1. 
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Figure 4.1: The perpendicular force acting on the wrench at some distance from the pivot point creates a 
torque. This “turning force” can also be represented as a moment at the pivot point. 


Torque: The Picture The most common way to think about a torque is a “force applied at a distance 
from the point of rotation.” We can illustrate this concept using the picture in Figure 4.2. 





Figure 4.2: Force being applied to a wrench. 


In Figure 4.2, a force Fis being applied to the wrench at a distance L from the rotation point at the 
origin O (note that F and L are both vectors!). Because of the separation between the application point 
of the force and the origin, we expect this force would cause the wrench to rotate, increasing its angular 
momentum. While qualitatively this scenario is easy to understand, it is important to add mathematical 
definition to the scenario, then look at some additional cases. 


Torque: Mathematical Definition The mathematical definition for a torque is given as: 


T=TxF 
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which relies on the cross product that you encountered earlier. Looking at the equation for a torque, there 
are several important characteristics we notice immediately: 


1. A torque, 7 is a vector, meaning that it has both a magnitude and a direction. 
2. Both rand F are vectors, so both magnitude and direction matter. 


3. Torque is dependent on the cross product between 7’ and F, so it is maximized when 7 and F' are 
perpendicular. 


Torque: Understanding the Vector Since torque is a cross product, it is (by definition) a vector quantity 
— it has both magnitude and direction. Often people want to talk about the “direction” of the torque as 
being “clockwise” or “counterclockwise” — and as a consequence, they will draw torque as a circular arrow. 
Indeed, moments are often represented on FBDs with circular arrows indicating direction of rotation that 
the moment “wants” to cause. 

Strictly speaking, though, the direction of the torque vector points along the axis of rotation, and the 
sign tells you whether the rotation is clockwise (negative) or counterclockwise (positive). You can again use 
a right hand rule to help you remember the signs; if you curl your fingers in the the direction of the rotation, 
your thumb will point in the direction of the torque vector. 

Now that we have the definition of torque, let’s work through a few examples to illustrate the character- 
istics above. 

The ideas we will be exploring in these exercises are also in the videos about the definition of torque and 
choice of origin if you would like to review after class. 


Exercise 4.1 


1. Consider a box, suspended in space (e.g. maybe you are actually in a spaceship in zero gravity 
with the box). You designate the following coordinate system for the box and apply a force at 
the bottom of the box in the —x direction. How does the box "want" to move? What is the 
direction of resulting torque about the box’s center of mass (in vector form)? 





. Now imagine that a torque is applied to the box about the box’s COM; the direction of the 


torque is in the —z direction. How does the box “want” to move? 


. Was our choice of coordinate system and origin a good one? What might have been a better 
choice? 
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Exercise 4.2 


Consider the wrench shown in Figure 4.3 that rotates about the origin O. 


1. For each force vector in Figure 4.3, find the associated torque about the origin O. Make sure to 
specify both the direction and magnitude of the torque. 


2. What change would need to be made to F’g in order for Tg = T4 (where 73 is the torque due 
to F'p and 74 is the torque due to F’,)? 


3. If point of rotation for the wrench was changed from the origin to the point (L, 0), how would 
that change the torque due to each force? 


Figure 4.3: Wrench under different force conditions. 


Exercise 4.3 


Consider the wrench again, but with the force F = 22 + 1j as shown in Figure 4.4. 


1. Find the torque about the origin O due to the force PF. 


2. Find the torque about the point (L, 0). 
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Figure 4.4: Wrench with a non-perpendicular applied force. 





4.2 Net Force and Net Torque [15 minutes] 


For these next exercises, we want to consider the concepts of net force and net torque acting on a body. By 
net force and net torque, we simply mean the vector sum of those quantities: 


Fas > F 
=> T 


Note: Generally when we calculate net torque for the purposes of dynamics, it’s helpful to use the object’s 
center of mass as an origin, whereas when we calculate the net torque for static problems, it is useful to 


and 


be “clever” about what you choose as an origin. Be careful that you use a single origin for calculating the 
torques though! 

Since we are not getting into the dynamics of objects right now, we’re not going to get too formal 
interpreting the net torque and net force. Qualitatively, the net force tells you how the object’s center of 
mass will accelerate, and the net torque about the COM tells you how about the object’s angular acceleration 
— how much it wants to “spin” about the center of mass, along the axis direction defined by the torque vector. 
There’s a fair bit of detail to getting the dynamics right (which is why we are not going there right now), but 
if you’re curious you can talk to an instructor, and you can also (as always) watch some videos here if you 
would like to review after class. 


Exercise 4.4 


Consider the wrench in Figure 4.5. This figure is a snapshot of a moment in time (t=o), right when 
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we apply the force, F. 
. What is the net force acting on the wrench? 
. What is the net torque acting on the wrench? 


. What motion would you expect to see in this scenario at t>o seconds (assuming a friction-less 
surface)? 


Figure 4.5: Yep, the wrench again. 


Exercise 4.5 


Consider the pencil in Figure 4.6. Let’s say we are looking down on this pencil as it lies on a 
friction-less surface, at the initial moment (t=o) of applying the forces shown. 


1. What is the net force acting on the pencil? 
2. What is the net torque acting on the pencil? 


3. What motion would you expect to see in this scenario (assuming a friction-less surface) at 
time >o seconds? 
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Figure 4.6: Oh hey, a pencil! 


CO 


4.3 Torque Practice [20 minutes] 





Exercise 4.6 


Imagine that you are riding a bicycle (without cleats or toe clips so you are only able to push down 


on the pedals). Assuming you push down with constant force as you pedal, at what point during a 
pedaling cycle is the torque applied by your feet around the center of the crank greatest? When is it 
least? What is the direction of the torque? 

Why do cleats and toe clips increase the torque you are able to apply? 
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Exercise 4.7 


Say you need a wrench to help you exert a 100 N-m torque. About how long should the handle be 
and why? 


Exercise 4.8 
Let’s say I’m trying to loosen a very stuck nut which is in a difficult to reach location. Iam using a 
wrench which is 20 cm long. I am capable of exerting a force of 100 N, but because of the awkward 
position, the direction of the force I exert is at an angle of 60 degrees to the wrench (or 30 degrees off 
of the perpendicular to the wrench). If the nut will require a torque of 16 N-m to come loose, will I 
succeed? 


CO 


4.4 Intro to Statics 





In Wednesday’s class, we'll take a deeper look at net torque and net force and what happens when these are 
zero (i.e. statics). If you finish the class work early, please watch the videos on statics for Wednesday (see 
first section of the homework). 
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Solution 4.1 


1. Consider a box, suspended in space (e.g. maybe you are actually in a spaceship in zero gravity 
with the box). You designate the following coordinate system for the box and apply a force at 
the bottom of the box in the —x direction. How does the box "want" to move? What is the 
direction of resulting torque about the box’s center of mass (in vector form)? 


It will want to move counterclockwise around the COM in the direction of the y axis, so the 
torque is in the +y direction. 


2. Now imagine that a torque is applied to the box about the box’s COM; the direction of the 
torque is in the —z direction. How does the box “want” to move? 


The block will want to move clockwise around the COM about the « axis (ie. if you moved 
the axis so that it went through the COM) 


3. Was our choice of coordinate system and origin a good one? What might have been a better 
choice? It would make more sense to place the origin at the COM. 


Solution 4.2 


1. For each force vector in Figure 4.3, find the associated torque about the origin O. Make sure to 
specify both the direction and magnitude of the torque. 


#4 = Lix Faj = LF ak 


Dx rm 4 
Tp = —1X Fpj = —F ek 
TB i BJ 5) B 


To = Lix —Foi=0 
fp = Lix —Fpj = —LFpk 


2. What change would need to be made to F’g in order for 7g = 74? The magnitude of F'g 
would need to double. Therefore, when you use a crescent wrench, you will need to apply 
less force if you grip it near the near the end of the handle. By the way, in real life, if you’re 
exerting the forces F’, or F’g, you will want to flip the wrench 180 degrees about its horizontal 
axis so that the largest force is on the stationary jaw. 


3. If point of rotation for the wrench was changed from the origin to the point (L, 0), how would 
that change the torque due to each force? 


74 = 01x Faj =0 


> 


L, * hue 
TB =——* Fp) aaa 


7c = 01 x —Foi =0 


7p = 01x —Fpj =0 


Solution 4.3 
Consider the wrench again, but with the force F = 2i + 1j as shown in Figure 4.4. 


1. Find the torque about the origin O due to the force PF. 


F=Lix2%+1j =Lk 
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2. Find the torque about the point (0, LZ). The torque about (0, L) would be zero because 7’=0 


Solution 4.4 


Consider the wrench in Figure 4.5. 


1. What is the net force acting on the wrench? Fu =-—Fi 
2. What is the net torque acting on the wrench? 7;,-; = 07 x —Fi =0 


3. What motion would you expect to see in this scenario (assuming a friction-less surface)? 
Translation in the —i direction. Specifically, we would expect a translational acceleration, 
since F.,., = —Fi = ma. 


Solution 4.5 
Consider the pencil in Figure 4.6. 


1. What is the net force acting on the pencil? Fret = >> F, = Fi— Fi = 0. No forces are acting 
in the y-direction. 


2. What is the net torque acting on the wrench? 


L. * Lis » Li» Ls . 


3. What motion would you expect to see in this scenario (assuming a friction-less surface)? 
Counter-clockwise (positive) rotation about the center of the pencil. Specifically, we would 
expect an angular acceleration in the counter-clockwise direction, because Trex = Id. 


Solution 4.6 


The maximum torque will be applied when the pedals are horizontal and the force applied by your 
foot is perpendicular to the crankset. The minimum torque will be applied when the pedals are 
aligned vertically, and the force from your feet is applied parallel to the crankset. At all points in the 
pedalling cycle, the torque will be oriented perpendicular to the pedaling plane (i.e. out of the plane 
in this picture, which is toward your left when you sit on your bike). Cleats and toe clips allow you 
to push and pull horizontally on the pedals, giving you more torque, especially when the pedals are 
aligned vertically. 


Solution 4.7 


Say you need a wrench to help you exert a 100 N-m torque. About how long should the handle be 
and why? 

Most people can lift a 20 lb (10 kg-ish) dumbbell in one hand, so they can probably exert F = mg = 
10 kg x 10 m?/s = 100 N of force and they could do so perpendicular to the wrench. So, to make a 
wrench that could exert 100 N-m of torque, you probably want about a 1 m long handle. 


Solution 4.8 


Let’s say I’m trying to loosen a very stuck nut which is in a difficult to reach location. Iam using a 
wrench which is 20 cm long. I am capable of exerting a force of 100 N, but because of the awkward 
position, the direction of the force I exert is at an angle of 60 degrees to the wrench (or 30 degrees off 
of the perpendicular to the wrench). If the nut will require a torque of 16 N-m to come loose, will I 
succeed? 

Yup! If you push at the very end of the handle (0.2 m), then your applied torque is 0.2 m x 100 N x 
sin 60°= 17.3 N-m, which exceeds the required torque. 
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Week 2b: Statics 
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5.3.2 Choosing and Working With Multiple Frames and Multiple Bodies (20 minutes) . . 44 





5-1 The Idea of Statics and Static Equilibrium - 20 minutes 


We discussed the idea of the net force and net torque acting on an object earlier. These ideas of net force and 
net torque are central to understanding whether the system is static — i.e., unchanging in time — or dynamic 
—ie., changing in time. 

A system is said to be in static equilibrium when the net force and net torque on every part of the system 
is zero. The net forces equaling zero is known as the first condition for equilibrium, and the net torque 
equaling zero is known as the second condition for equilibrium. 

The two conditions for equilibrium lead to the following basic equations (where we use bold to represent 
a vector): 


Exercise 5.1 


Static Equilibrium Conceptual Questions 


1. What do the two conditions for static equilibrium say about the linear and angular acceleration 
of the system? 


. For a system to be in static equilibrium, does it need to be at rest? Why or why not? 


. For atwo-dimensional (x,y) system, how many equations are needed to prove static equilibrium? 
Please write them. How about for a three-dimensional (x,y,z) system? 


. For a two-dimensional (x,y) system in static equilibrium, what is the maximum number of 
unknown forces/torques that can be solved for? How do you know this? 
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5. What does it mean for a problem to be “statically determinate” versus “statically indeterminate”? 
Use the interwebs to investigate this. Then draw a simple example of a statically indeterminate 


system, and explain what makes it indeterminate. 


—_———————SSes 


5.2 Free Body Diagrams (again!) 





5.2.1 Strategies for FBDs (5 min) 


Having a consistent methodology when drawing free body diagrams can be really helpful when analyzing 
systems. Below are some questions to consider: 


Questions to Consider Before the FBD 
* How will the system behave? (i.e., Play the movie in your head. Is this a static or dynamic system?) 
+ What are the aspects of the system you care about? 


« Should you divide your system into multiple components or subsystems? Keep in mind that sometimes 
you need to draw multiple free body diagrams in order to properly analyze a situation and identify 
interaction forces and torques, etc. 


+ What interactions do you need to capture in your analysis? (i.e., what are the forces and/or torques 
acting on the various parts of your system? Are these forces/torques captured in your free-body 
diagrams?) 


« How can you capture those interactions on a diagram or a set of diagrams? (i.e., what does the 
free-body diagram look like for this system and its components?) 


+ What are the important directions and locations in the problem - and given this, what are the 
appropriate frames of references to analyze this system? 


How you choose to visualize your system and its components can impact your ability to understand and 
ultimately complete your analysis. A clear and complete free body diagram (or multiple free body diagrams) 
can help you clarify your own understanding of the system, derive appropriate equations of motion (more 
on this later in the course), quickly evaluate the accuracy of your work, and get help from others (because 
they can see how you are understanding the system!). 


Steps for Drawing aFBD As you begin to create free body diagrams, here are some suggested steps to 
consider following: 


« Make a decision as to which system (a body or collection of bodies) you will be analyzing. You may 
identify the need to break your system into multiple subsystems. 


* Choose a body or combination of bodies isolated from all surrounding bodies. 


* Observe which forces and/or torques are exerted on the body or combination of bodies you have 
chosen. 


+ Label forces and torques, with appropriate directions. (NOTE: You may need to arbitrarily assign a 
direction at times, in which case you may subsequently find through analysis that the magnitude of 
the force in the direction you have chosen is negative, which is fine! Forces do not have to be positive, 
but it’s useful to draw them in the positive direction when possible.) 


¢ Choose and label reference frames. 
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5.2.2 Practicing FBDs for static cases (30 minutes) 


Exercise 5.2 


Consider the pinned beam with constant cross section and mass distribution shown in Figure 5.1 
below. The beam is supported at one end by a pinned joint. This particular type of joint can provide 
linear support for reaction forces in any direction, but cannot support a turning moment, since it 
rotates about the pin (If interested, you can learn more about types of load supports here. At the 
other end of the beam is a rope which can only support tension along its axis, attached to a fixed 
point. For this exercise, you can assume the beam is stationary (a = a = 0, v 6 = 0). 








Rope to 
fixed point 


Pinned 


support at wall 
Beam of mass M 





Figure 5.1: A pinned beam supported by a rope. 


. Explain what is meant by “this particular type of joint can provide linear support for reaction 
forces in any direction, but cannot support a turning moment.” 


. When drawing a free body diagram for the pinned beam in Figure 5.1, which body should you 
isolate? 


. Draw the FBD for the body you have isolated, paying special attention to the steps outlined 
above. 


. Is the beam in static equilibrium? How do you know? 


. Write the appropriate equations for find the unknown forces and torques acting on the beam. 
How many equations are there? 


. How many unknowns do you have in your system of equations? 


. Is the pinned beam system statically determinant? Why or why not? 





5-3 Free Body Diagrams With Multiple Bodies 


In the previous exercises you drew simple FBDs for systems with a single body (a beam). Next, we will 
consider systems with multiple subsystems, building off the work we did last week. 
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5-3-1 What is a Reference Frame? 


A reference frame is an explicitly defined framework in which we can make observations and write physical 
laws. A reference frame is defined by a coordinate system, an observer, and some definition of time. For 
statics problems, the primary component we are interested in are relationships between different coordinate 
systems. For dynamic systems, however, time and the observer play a very important role. We will be diving 
deeper into the concept of reference frames in the Robotics module, and again in QEA 3. 

A coordinate system consists of an origin and a set of basis vectors. Recall that a set of vectors 
form a basis if they are linearly independent—if they are mutually orthogonal then we have an orthogonal 
coordinate system. The standard basis vectors for 2D are usually labelled i and j, but they are sometimes 
written as e; and eg, or e; and e,, or X and ¥. 


5-3-2 Choosing and Working With Multiple Frames and Multiple Bodies (20 
minutes) 


Exercise 5.3 


For this exercise, refer to the system below. 


Figure 5.3: Box of mass M on an inclined ramp. The ramp is not fixed to the floor, and the box is not 
fixed to the ramp. 


Suggest two useful reference frames for this system. For each reference frame, draw the two 
orthogonal unit vectors, as well as what you suggest for an origin. 


Exercise 5.4 


. Draw a FBD for the box by isolating it from the ramp. Draw and label appropriate vectors for 
the forces acting on the box. 


. Draw a FBD for the ramp. Draw and label appropriate vectors for the forces. 


. Compare the two FBDs, and make sure that your interactions make sense - e.g., if the ramp is 
pushing up on the box, the box better be pushing down on the ramp! 


. Look carefully at the force vectors you have drawn for the box and ramp FBDs. What reference 
frame is each force defined in (e.g. for the box, gravity is likely in the global j direction, while 
the normal force is in the ramp ¥ direction)? Make a table like the one below explicitly defining 
each force/frame. 
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| Force | Acting On | Reference Frame | Direction (e.g. +?) | 
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Solution 5.1 


Static Equilibrium Conceptual Questions 


1. What do the two conditions for static equilibrium say about the linear and angular acceleration 
of the system? 
Applying Newton’s second law, )> F = maand 5° 7 = Ja (for rotation of a rigid body about 
the center of mass) we know that the linear acceleration a = 0 and the angular acceleration 


0G=a=0. 


2. For a system to be in static equilibrium, does it need to be at rest? Why or why not? 
No, for a system to be in static equilibrium, the net force and torques acting on the system 
must be zero, leading to linear acceleration a = 0 and the angular acceleration 6=a=0. 
This means that the system can be traveling at a constant angular or linear velocity while still 
satisfying the two conditions for static equilibrium. 


3. For atwo-dimensional (x,y) system, how many equations are needed to prove static equilibrium? 
Please write them. How about for a three-dimensional (x,y,z) system? 
For a two-dimensional (x,y) system, three equations are needed: 


n= 0 


Note that 7, refers to the torque pointed along the z axis (out of the page or into the page for a 
2D system). For a three-dimensional (x,y,z) system, the number of equations increases to six: 


at 
SF, =0 
1 =6 
se =0 
y e=0 
+ 40 


4. For a two-dimensional (x,y) system in static equilibrium, what is the maximum number of 
unknown forces/torques that can be solved for? How do you know this? For a two-dimensional 
(x,y) system in static equilibrium, we know that there are three equations that must be satisfied 
as indicated above, all of which represent the net forces/torques in the respective directions, 


> he =0 


> a0 
> 1 =0 


If we have more unknowns than equations, we are not able to determine these unknowns. So, 
with only these three equations, we can solve a maximum of three unknowns. If the number of 
unknowns exceeds the number of equations, the system is know as “statically indeterminate,” 
and cannot be solved without additional information. If there are fewer unknowns than the 
number of equations, the system would be considered "overdetermined," i.e., not physically 
possible. When the number of equations equals the number of unknowns, our system is 
"determinate", which means "having exact and discernible limits." 
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5. What does it mean for a problem to be “statically determinate” versus “statically indeterminate”? 
Use the interwebs to investigate this. Then draw a simple example of a statically indeterminate 
system, and explain what makes it indeterminate. See previous problem. 


Solution 5.2 


1. Explain what is meant by “this particular type of joint can provide linear support for reaction 
forces in any direction, but cannot support a turning moment.’ Physically, this means you can 
“pull” or “push” against the pin in any direction, and it will resist that force, but since it’s a pin, 
the object is free to rotate about it. Therefore the pin can apply an arbitrary force to the object 
that it is attached to, but cannot apply a torque about the pin. 


2. When drawing a free body diagram for the pinned beam in Figure 5.1, which body should you 
isolate? For the pinned beam in Figure 5.1, you want to isolate just the beam portion of the 
drawing as shown below. 


3. Draw the FBD for the body you have isolated, paying special attention to the steps outlined 
above. The FBD for the pinned beam is shown in 5.2. Notice that we’ve chosen to represent all 
of the weight as a point force, Fg, acting at the center of mass. This ends up being a simplifying 
shortcut that gives us an accurate result when the mass is equally distributed along the beam 
(i.e., the mass/length does not change). At the pin, we expect F’p as the reaction force, acting 
in some unknown direction. For our computational convenience, we define the x-component 
of Fr, acting along the x-axis, Ppz, and FR, acting along the y-axis (these vectors are not 
necessarily drawn to scale in the figure). We are doing this in anticipation of summing the 
forces in the x and y directions. Incidentally, we are calling them ‘reaction’ forces as a nod to 
Newton’s law that states, "For every action, there is an equal and opposite ’re-’ action." These 
forces are re-acting to the applied force labeled T. (What happens to these re-acting forces 
when we remove T)? 








Figure 5.2: FBD for the pinned beam. 


4. Is the beam in static equilibrium? How do you know? Yes, in the problem statement we were 
told for this exercise, you can assume the beam is stationary a = a = 0, which satisfies the 
conditions for static equilibrium. 


5. Write the appropriate equations for finding the unknown forces and torques acting on the 
beam. How many equations are there? There are three equations: 


\ > Fy = 0 = Fre + T cos 
\) F, =0 = Fry — Fe + T sind 


‘7 
a= —Fox + Tsin6L 
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6. How many unknowns do you have in your system of equations? Three unknowns: T,, F’pz., 
and Fry. 


7. Is the pinned beam system statically determinant? Why or why not? Yes, the system is statically 
determinant because the number of equations equals the number of unknowns. 


Solution 5.3 


The most logical answer here is to create a “global frame” and a “ramp frame”. The global frame 
is defined by the unit vectors i. j]. The 7 vector should be parallel to the floor, with the j vector 
perpendicular to the floor. The “ramp frame” is defined by the unit vectors [#, 9]. The @ vector should 
be parallel to the ramp, with the 7 vector perpendicular to the ramp. See below. Note that when 
focusing on forces, the position of the origin of each frame is not particularly important, but if we 
were concerned with the motion of the ramp and the box, we would want to think carefully about 
the position of each coordinate system (e.g. we may have three frames, with a global fixed coordinate 
system, and a coordinate systems with an origin fixed to the ramp and box respectively). 





Figure 5.4: Global and ramp reference frames defined for the box-on-a-ramp. 


Solution 5.4 


1. Draw a FBD for the box by isolating it from the ramp. Draw and label appropriate vectors for 
the forces acting on the box. 
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Figure 5.5: FBD for the isolated box. 


2. Draw a FBD for the ramp (ramp mass=/M/p). Draw and label appropriate vectors for the forces. 
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Figure 5.6: FBD for the isolated ramp. 


3. Look carefully at the force vectors you have drawn for the box and ramp FBDs. What reference 
frame is each force defined in (e.g. for the box, gravity is likely in the global 7 direction, while 
the normal force is in the ramp ¥ direction)? Make a table like the one below explicitly defining 


each force/frame. 




















Force Acting On | Reference Frame | Direction 
Gravitational force (weight of ramp) Ramp Global Frame -j 
Floor normal force Ramp Global Frame +) 
Floor frictional force Ramp Global Frame +4 
Normal force from box to ramp Ramp Ramp Frame -9 
Friction force from box to ramp Ramp Ramp Frame +4 
Friction force from ramp to box Box Ramp Frame -—& 
Normal force on box from ramp Box Ramp Frame +9 
Gravitational force (weight of box) Box Global Frame =| 
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Homework 2: Torque and Static 
Equilibrium 
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6.1 Video Review of Statics 


Please do the Video Review section (about 20 minutes of work) before class on Wednesday—the 
rest of the homework is due as usual 


Exercise 6.1 


Video Review: 


1. Visit this link and watch the video about equilibrium titled “A Statics Example”. After watching 
the video, make a table of key concepts. Include simple sketches where appropriate to illustrate 


these concepts. For extra credit (whatever that means) find the mistake in the video (and yes, 
there is a REAL mistake in the video, not some minor pedantic thing). 


2. Also watch this video, which provides another example of drawing a FBD and thinking about 
the torques in the problem. This particular example is not a static example, but it talks 
qualitatively about what the effect of torques will be. 





6.2 Statics Continued! 


Exercise 6.2 


Consider the cantilevered beam with constant cross section and mass distribution shown in Figure 6.1 
below. The beam has mass M, and is supported at one end by a fixed joint, which can provide linear 
support (or reaction) forces, and moments. For this exercise, you can assume the beam is stationary 
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Fixed support 
at wall 
Beam of mass M 





Figure 6.1: A cantilevered beam of mass M. 


. “A fixed joint can provide linear support (or reaction) forces, and moments”. Explain why this 
is so. 


. When drawing a free body diagram for the cantilevered beam in Figure 6.1, which body should 
you isolate? 


. Draw the FBD for the body you have isolated, paying special attention to the steps outlined 
above. 


. Is the beam in static equilibrium? How do you know? 


. Write the appropriate equations for find the unknown forces and torques acting on the beam. 
How many equations are there? 


. How many unknowns do you have in your system of equations? 


. Is cantilevered beam system statically determinant? Why or why not? 


Exercise 6.3 


You may have seen this coming, but let’s consider the cantilevered beam, of constant cross section 
and mass distribution, with a rope, shown in Figure 6.3. 


Rope to 
fixed point 


Fixed support 
at wall 


Beam of mass M 





Figure 6.3: A cantilevered beam of mass M with a rope attached to a fixed point. 
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. Draw the FBD for the system in Figure 6.3, paying special attention to the steps outlined above. 


. Write the appropriate equations for find the unknown forces and torques acting on the beam. 
How many equations are there? 


. How many unknowns do you have in your system of equations? 


. Is the system statically determinant? Why or why not? 


Exercise 6.4 


For this exercise, refer to the system below that we started talking about in class. You should use the 
reference frames that we developed in class for this problem (i.e., the global frame, and the ramp 
frame). Assume, for the sake of this problem, that the system is static, that the box has mass M, that 
the ramp has mass m, and the angle of the ramp is 0. 


Figure 6.5: Box of mass M on an inclined ramp. The ramp is not fixed to the floor, and the box is not 
fixed to the ramp. 


1. Write down an equation for the summation of all of the forces acting on the box, and an 
equation for all forces acting on the ramp. You should include the unit vector associated with 
each force (i.e. )> F = — Wd — Ffriction® + ...). How many unknown quantities do you have 
here? How many equations? Is this problem determinate or indeterminate? 


. Typically, for a 2D problem, we would split the force equation into two equations, }~ F; and 
> F; (or commonly >) F, and )/ Fy). Can we do that here? What about the forces that are 
defined in the [%, j] frame? 


. We need to represent all of our forces in a common reference frame in order to perform analysis. 
In the Faces Modules, you encountered the concept of rotation matrices, and we can apply that 
idea here to relate the global frame and the ramp frame. 


(a) Draw the unit vectors that define the global and ramp frame co-located at the same origin. 
Specify the angle @ that defines the rotation between the two coordinate systems. 

(b) Write equations for ¢ and ¥ in terms of dand j. 

(c) Rewrite the equations above in the form of a rotation matrix. 


(d) Rewrite your force equations so all of the forces are expressed in the global reference 
frame |i, j], then split each force equation into the 2 and 7 components (i.e. you should 
end up with four equations for > F,,,..2, >» HT ee yy aes: ie 





ampj) 
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4. Assume now that the box has mass M = 1 kg, that the ramp has mass m = 2 kg, and the angle 
of the ramp is 0 = 7/6. Using the magic of matrices, solve the resulting system of equations 
for the unknown forces. 


. In solving for this system of equations, you should have obtained two normal forces as well as 


two frictional forces. You found these by assuming that the system was at equilibrium. Now 
you should check that assumption: are the resulting normal and frictional forces possible? In 
particular, what coefficients of static friction are needed between the block and the ramp and 
between the ramp and the ground in order to meet the static condition? 


Co 


6.3 Revisiting Torque 





Exercise 6.5 


A force with vector representation F =3i+ 2} is acting at a location 7 = 1j + 5k. What is the torque 
due to this force about the origin? What is the torque due to this force about the point 7 = Tt + 3k? 
You might need to review the process of computing the cross-product of two vectors to complete 
this exercise. Consider the Rule of Sarrus for the procedure, or the physical interpretation. 


Exercise 6.6 


The picture below shows a person trying to tighten a nut with a wrench. The point of view is that of 
standing, facing the end of the bolt as shown and turning clockwise. Draw a free body diagram for 


1. The wrench only 


2. The nut only 


In drawing your free body diagram, call out the forces acting between surfaces (i.e., don’t just draw 
a moment on the nut!) Then, using your FBDs, explain how the wrench is used to tighten the nut. 
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Solution 6.2 


“A fixed joint can provide linear support (or reaction) forces, and moments”. Explain why this 
is so. Since the end is fixed, you can imagine trying to pull on the joint in any direction — and 
the joint resisting — but you can also imagine trying to rotate the object about the joint, and 
the joint reacting. 


When drawing a free body diagram for the pinned beam in Figure 5.1, which body should you 
isolate? For the cantilevered beam in Figure 6.1, you want to isolate just the beam portion of 
the drawing as shown below. 


. Draw the FBD for the body you have isolated, paying special attention to the steps outlined 


above. The FBD for the cantilevered beam is shown in 6.2. We’ve used the same treatment for 
the reaction force at the wall as we did for the pin in the above cantilever; its components, Fr, 
and Fry are shown at the joint in the x and y directions, respectively. We have also drawn 
a circular arrow to represent a reactive turning moment, Mp,, at the wall. We drew this on 
our FBD because we know by experience that the Fg produces a clockwise turning moment. 
Since the beam is not moving, this moment must be offset by an equal an opposite one at the 
wall connection. 








Figure 6.2: FBD for the cantilevered beam. Vectors are not necessarily drawn to scale. 


4. 


Is the beam in static equilibrium? How do you know? Yes, in the problem statement we were 
told For this exercise, you can assume the beam is stationary a = a = 0, which satisfies the 
conditions for static equilibrium. 


Write the appropriate equations for find the unknown forces and torques acting on the beam. 
How many equations are there? There are three equations: 


>) +. =0=Fe 
\\ FB, =0= Fry - Fe 


3 
> =0=-Fo5 + Mr 


. How many unknowns do you have in your system of equations? Three unknowns: Mp, FRx, 


and Fry. 


. Is the cantilevered beam system statically determinant? Why or why not? Yes, the system is 


statically determinant because the number of equations equals the number of unknowns. 


Solution 6.3 


. Draw the FBD for the system in Figure 6.3, paying special attention to the steps outlined above. 


The FBD for the cantilvered beam with a rope is shown in 6.4. In the diagram, FR, and Fry 
are the reaction forces from the fixed joint in the x and y directions respectively, and Mp, is 
the reaction moment. 
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Figure 6.4: FBD for the cantilevered beam with a rope. 


2. Write the appropriate equations for find the unknown forces and torques acting on the beam. 
How many equations are there? There are three equations: 


S° Fy = 0 = Fre + T cos 
S 0 Fy =0 = Fry — Fo + Tsind 


& 
2% i= ie, + TsindL + Mr. 


3. How many unknowns do you have in your system of equations? Four unknowns: Mpr.-, Fre, 
Fry, and T. 


4. Is the system statically determinant? Why or why not? No, the system is statically in- 
determinant because the number of equations is less than the number of unknowns. 


Solution 6.4 


1. Write down an equation each for the summation of all of the forces acting on the box and 
ramp. You should include the unit vector associated with each force (i.e. )> For = —F oj — 
Fpriction® an we). 


> Fagg == Wd — F frietion® + Neagt 


2 Pantie = —Ferij ae Newmed + PF pricest 7 J ese8 ae Prowl) 


2. Typically, for a 2D problem, we would split the force equation into two equations, )> F; and 
> F;; (or commonly >= F, and )> Fy). Can we do that here? What about the forces that are 
defined in the |, 7] frame? Can forces in different framed be added? 


Yes, we can split these equations into two separate equations, but not before we represent all 
of the forces in the same reference frame. Forces in different reference frames do not add, so 
we must choose one frame for the whole system. 


We need to represent all of our forces in a common reference frame in order to perform analysis. In 
the Faces Modules, you encountered the concept of rotation matrices, and we can apply that idea 
here to relate the global frame and the ramp frame. 


1. Draw the unit vectors that define the global and ramp frame co-located at the same origin. 


Specify the angle @ that defines the rotation between the two coordinate systems. 
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Figure 6.6: Unit vectors that define the two coordinate systems in the box-on-a-ramp problem. 


2. Write equations for ¢ and % in terms of i and j. 


3. Rewrite the equations above in the form of a rotation matrix. 
é] _ [cos@ —sin6] [2 
g| —|sin@ cos 8 | |7 


4. Rewrite your force equations so all of the forces are expressed in the global reference frame 
(7, 7], then split each force equation into the 2 and 7 components (i.e. you should end up with 


four equations for )> F;,,.3, > ee > Pena > DF ecagh): 
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“Note: Friction = Fy for simplicity** 
> Por? = ~Pfbox COS Oi + Noox sin 01 = 0 


S> For} = —Foboej + Fyton sin j + Noo cos 03 = 0 
S” Frampi = Fframpt + Ffror C08 0% — Fhow sin 01 = 0 


>, en: = —F ramp) + pe ~ Prpox sin 05 _ Peete cos 03 =U 


Note that we’re using Npox to refer to the normal force on the box from the ramp and F45, to 
refer to the force on the ramp from the box, but these are, by definition, equal and opposite. 


5. Assume now that the box has mass M = 1 kg, that the ramp has mass m = 2 kg, and 
the angle of the ramp is 6 = 7/6. Using the magic of matrices, solve the resulting system 
of equations for the unknown forces. You could solve the equations in a lot of different 
ways. You could start with the box equations, solve for F’rp5z and Nox and then plug those 
numbers into your other equations, solve, etc. However, looking at the equations above, 
there are some nifty cheats. Looking at both of the i equations, we see that you can plug 
(1) into (3) and F’f;amy, is simply equal to zero. Similarly, for j, plugging equation (2) into 
(4) gives me Nramp = Foramp + Fobor = (M + m)g. This makes sense, especially if 
you think about the system of the ramp and box together. Solving the box equations yields 
F bor = Mgsin9 = Mg/2 and Noor = Mgcos0 = V3/2Mg 


6. In solving for this system of equations, you should have obtained two normal forces as well as 
two frictional forces. You found these by assuming that the system was at equilibrium. Now 
you should check that assumption: are the resulting normal and frictional forces possible? In 
particular, what coefficients of static friction are needed between the block and the ramp and 
between the ramp and the ground in order to meet the static condition? F'f-amp = 0 so the 
coefficient of friction between the ramp and the floor could be anything! Fo, = Mg/2 < 
Lk-Noox 80 [ty > 0.577. This is reasonable for many materials including steel on steel or rubber 
on concrete. 


Solution 6.5 


A force with vector representation F = 314-27 is acting at a location 7 = 1j + 5k. What is the torque 
due to this force about the origin? What is the torque due to this force about the point 79 = 72 + 3k? 
# x F gives you —10i + 15j — 3k, (# — 7) x F gives you —4i + 6j — 17k 


Solution 6.6 


The picture below shows a person trying to tighten a nut with a wrench. The point of view is that of 
standing, facing the end of the bolt as shown and turning clockwise. Draw a free body diagram for 


1. The wrench only 
2. The nut only 


In drawing your free body diagram, call out the forces acting between surfaces (i.e., don’t just draw 
a moment on the nut!) Then, using your FBDs, explain how the wrench is used to tighten the nut. 
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Chapter 7 


Week 3b: Introduction to the Ducky 
on a Ramp 





Schedule 
7a Upright Ducky. 6c ee ee ee ee ee Ee eee & 61 
wa Rotated DUCKY sik bei ew A we EW Ew we 61 
74 Ducky ona Raiip. sc eR Oe EE 63 
wa Key Iipredients ob i ee EE EEN Oe OE EEN ES ORO Oe 64 





Note (where’s 3a?): Due to the Holiday, we only have class once this week. Thus Week 3a has been 
obliterated. 

Important setup notes: Jeff made a ton of materials for this problem for the 2020 offering of QEA. 
Visit this Google Drive folder to download Matlab code for the ducky problem. You can also view a video 
introduction to the Ducky problem here. 

In the overnight assignment you will be solving a timeless problem that has plagued generations of the 
world’s brightest engineers- what angle does a ducky assume when sitting on an inclined surface? 





Figure 7.1: It is important not to confuse a duckling on a ramp (left) with a ducky on a ramp (right). Ducklings 
have fancy balancing systems comprised of brains and muscles and things. Duckies do not. 


You may think this problem is ridiculous, and you are absolutely right, especially since our “ducky” 
is a simple circular segment. Even though the framing of this problem is intentionally silly, the learning 
objectives are very real and crucially important to engineering practice. The ability to analyze a problem, 
draw accurate free body diagrams, and interpret and define forces is foundational to the advanced skills you 
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will learn later in QEA, at Olin, and in your professional careers. Namely, you'll use a very similar analysis 
procedure to design a boat at the end of the module! 

In the next two overnight assignments you will analyze this problem and ultimately calculate the 
equilibrium angle for the ducky sitting on an inclined ramp. You will do this through analysis, not through 
experiments. You will also predict the maximum ramp angle will cause the ducky to either flip over or slide 
down the ramp. 

If we were still at Olin, You would then test your predictions live, in class, in real time. You would not 
be allowed to perform experiments to develop your angle predictions, so you would need to trust your 
calculations. Unfortunately, in our current remote working environment, we will not be able to do these 
experiments as a group. 


7.1 Upright Ducky 


For this exercise, the “ducky” is defined as a circular segment with radius r and segment height h as shown 
in Figure 7.2. The circular segment is defined in the reference frame of the ramp with unit vectors [%, ij]. 
The circular segment has unit thickness (a thickness of 1 unit), and is constructed from a uniform density 
material. The center of mass of the circular segment is located at [%, 7], and is denoted by CG in Figure 7.2. 


y 


‘ 





Figure 7.2: The circular segment “ducky” 


Exercise 7.1 
. How high is the center of the circle above the line of y = 0?. 


. Draw a free body diagram for the ducky (circular segment). Label the center of gravity (CG) 
and point of contact between the segment and the ground. Make sure your forces are applied 
at one of these two points. 


. Based on your FBD, will the ducky rotate? Why or why not? 





7.2 Rotated Ducky 


In order to understand the problem of a ducky on a ramp, we need to draw multiple free body diagrams of 
relevant scenarios. The goal of these FBDs is to understand the forces and torques acting on the body, and 
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identify if a static equilibrium condition is possible. We'll start by analyzing the case where the ducky is 
rotated a bit on a flat surface. 


y 


' o>) 





Xcontact 


Figure 7.4: The ducky rolled to an angle ¢ relative to the ¥ axis. 


Exercise 7.2 
. What height is the center of the circle (Note: not the center of gravity) above the line y = 0? 


. Write down (or look up!) the equation for a circle centered about a point cz, cy with radius r. 
You will use this to define the circular segment “ducky”. 


. At @ = 0 the center of the circle has c,, = 0 and the height you found above. Using those 
values of cz, Cy, solve your circle equation for y in terms of x and r. Your equation should 
have two “branches”; that is, it should have a +. You will use this expression in the homework 
assignment. 





. Based on the schematic above (Fig. 7.4), which moved to the right more: xoq OF Xcontact? 


. Draw a schematic of the ducky sitting on flat ground, but rolled to an angle ¢ > 0 relative 
to the ¥ axis, as shown in Figure 7.4. Your schematic must include both the ducky and the 
ground. Draw a dot for the CG and the contact point, and label both. (Note that this is not a 
FBD; do not draw any forces on this diagram.) 


. Now draw a FBD of the ducky. Make sure to note the CG and contact point on your FBD, and 
make sure all forces are applied at one of these two points. 


. Is the ducky in static equilibrium with ¢ > 0? Why or why not? 


. If rotated to an angle ¢ > 0, will the ducky roll back to ¢ = 0? How do you know? 
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7.3 Ducky ona Ramp 


Now, we need to consider the case where the ducky is sitting on a ramp tilted at angle 0. There are two 
interesting scenarios to consider, the initial condition of the segment before it rolls (¢ = 0°), and after the 
segment has reached an equilibrium condition. A diagram of the ducky on the ramp is shown in Figure 7.7. 





lcontact 


Figure 7.7: The ducky rolled to an angle ¢ on an inclined ramp with angle 0. 


Exercise 7.3 


. Draw a schematic diagram of the ducky on a ramp titled at angle @ and with ¢@ = 0. Your 
schematic must include both the ducky and the (rotated) ramp. Draw a dot for the CG and 
the contact point, and label both. (Note that this is not a FBD; do not draw any forces on this 
diagram.) 


. Draw a free body diagram of the ducky on a ramp titled at angle 0 and with ¢ = 0. make sure 
that all your forces are applied at either the CG or the contact point. 


. Draw a schematic diagram of the ducky on a ramp titled at angle @ and with @ > 0. Your 
schematic must include both the ducky and the ground. Draw a dot for the CG and the contact 
point, and label both. (Note that this is not a FBD; do not draw any forces on this diagram.) 


. Draw a free body diagram of the ducky on a ramp titled at angle 6 and roll angle ¢ > 0. make 
sure that all your forces are applied at either the CG or the contact point. 


. For the case of ¢ = 0, is the ducky in static equilibrium? Explain. 


. What conditions would need to exist for the ducky to be in static equilibrium? 


. Compare the scenario where 6 > 0, ¢ > 0 to the block-on-a-ramp problem from last week. 
How is this ducky scenario the same? How is it different? 
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7.4 Key Ingredients 


Exercise 7.4 


1. Is there anything special about the ducky that causes it to right itself? (aka to not fall over) 
Compare the ducky against this “top-heavy” body (Fig. 7.12). Does the top-heavy body right 
itself? Give an explanation in terms of the CG and contact point. 


2 > 


Catal 


Figure 7.12: A top-heavy body; note how its CG moves compared to its contact point as you 
rotate the body. 


2. The previous question reveals that in order to solve the ducky problem, we'll need to be able to 
compute the CG and contact point. Conceptually, how would you compute the center of mass 
(CG) of the ducky? (You'll do this numerically in tonight’s homework using your boat code.) 


. Conceptually, how would you compute the contact point of the ducky? Hint: Above you noted 
that the center of the circle (not the CG) remains a fixed distance r perpendicular away from 
the ground (tilted or not). 
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Solution 7.1 
1. How high is the center of the circle above the line of y = 0?. 
(a) The center of the circle is r units above y = 0. 


2. Draw a free body diagram for the ducky (circular segment). Label the center of gravity (CG) 
and point of contact between the segment and the ground. Make sure your forces are applied 
at one of these two points. 


Figure 7.3: Free body diagram for the ducky at ¢ = 0°. 


3. Based on your FBD, will the ducky rotate? Why or why not? 


(a) The ducky will not rotate. Both the force of gravity F and normal force Fy act along a 
line through the center of gravity (aka center of mass). This will not lead to rotation of 


the body. 


Solution 7.2 
1. What height is the center of the circle c, (Note: not the center of gravity) above the line y = 0? 


(a) The center of the circle is still r units above y = 0. 
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2. Write down (or look up!) the equation for a circle centered about a point c,, cy with radius r. 


You will use this to define the circular segment “ducky”. 





(a) The equation for such a circle is r? = (x — cx)? + (y — cy)?. 


3. At d = 0 the center of the circle has c, = 0 and the height you found above. Using those 
values of cz, Cy, solve your circle equation for y in terms of x and r. Your equation should 
have two “branches”; that is, it should have a +. You will use this expression in the homework 
assignment. 


(a) The solution is y = r+ Vr? — x?. 


4. Based on the schematic above (Fig. 7.4), which moved to the right more: xoq OF Xcontact? 








(a) The contact point 2 ontact moved further than rcoq. 


5. Draw a schematic of the ducky sitting on flat ground, but rolled to an angle ¢ > 0 relative 
to the 7 axis, as shown in Figure 7.4. Your schematic must include both the ducky and the 
ground. Draw a dot for the CG and the contact point, and label both. (Note that this is not a 
FBD; do not draw any forces on this diagram.) 


Schevaavic 


Cot ac FT 


Figure 7.5: Schematic diagram of ducky at an angle of roll ¢, on flat ground. 


6. Now draw a FBD of the ducky. Make sure to note the CG and contact point on your FBD, and 
make sure all forces are applied at one of these two points. 


69 


CHAPTER 7. WEEK 3B: INTRODUCTION TO THE DUCKY ON A RAMP 


FYD 





Figure 7.6: Free body diagram for the ducky at an angle of roll ¢, on flat ground. 


7. Is the ducky in static equilibrium with ¢ > 0? Why or why not? 


(a) The ducky is not in static equilibrium in this condition; the force of gravity and normal 
force could cancel, but the normal force is no longer applied along a line with the CG. 
This will apply a torque on the body, causing it to rotate. 


8. If rotated to an angle ¢ > 0, will the ducky roll back to ¢ = 0? How do you know? 


(a) Trick question—it depends! When ¢ > 0 but small, a restoring moment is created by 
the horizontal separation of Fy and Fy. This restoring moment will act to restore @ to 
@ = 0. However if ¢ is too large the CG will move beyond the contact point and cause 
the ducky to fall over. It will land on its back (and be sad). 


Solution 7.3 


1. Draw a schematic diagram of the ducky on a ramp titled at angle 6 and with ¢ = 0. Your 
schematic must include both the ducky and the (rotated) ramp. Draw a dot for the CG and 
the contact point, and label both. (Note that this is not a FBD; do not draw any forces on this 
diagram.) 
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Figure 7.8: Schematic diagram for the ducky on a ramp at angle @ and with ¢ = 0°. 


2. Draw a free body diagram of the ducky on a ramp titled at angle @ and with ¢ = 0. make sure 
that all your forces are applied at either the CG or the contact point. 
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Figure 7.9: Schematic diagram for the ducky on a ramp at angle @ and with ¢ = 0°. 
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3. Draw a schematic diagram of the ducky on a ramp titled at angle @ and with @ > 0. Your 
schematic must include both the ducky and the ground. Draw a dot for the CG and the contact 
point, and label both. (Note that this is not a FBD; do not draw any forces on this diagram.) 
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Figure 7.10: Schematic diagram for the ducky on a ramp at angle 6 and with ¢ > 0. 


4. Draw a free body diagram of the ducky on a ramp titled at angle @ and roll angle ¢ > 0. make 
sure that all your forces are applied at either the CG or the contact point. 
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Figure 7.11: Free body diagram for the ducky on a ramp at angle @ and with ¢ > 0. 


5. For the case of ¢ = 0°, is the ducky in static equilibrium? Explain. 


(a) No, when the ducky is at 6 = 0° and the ramp is at an incline 0, the center of gravity, CG, 
is no longer directly above the contact point between the ducky and the ramp. Because 
the gravitational force, Fg acts at CG, and the normal force N acts at the contact point, 
a clockwise moment is present. The segment might also be out of equilibrium if the 
frictional force between the ramp and the segment is not sufficient and the segment slips 
down the ramp. 


6. What conditions would need to exist for the ducky to be in static equilibrium? 


(a) From looking at the FBD, we can identify two important criteria. The frictional force 
most be sufficient to prevent slipping, and the gravitational force must act through the 
contact point. Put differently, the CG and the contact point must be aligned vertically in 
the global reference frame, so that there is no moment. 


7. Compare the scenario where 0 > 0, ¢ > 0 to the block-on-a-ramp problem from last week. 
How is this ducky scenario the same? How is it different? 


(a) Like the box-on-a-ramp problem the ducky experiences gravity, a sloped normal force, 
and a sloped friction force. Unlike the box, the ducky is free to rotate through an additional 
angle ¢. 
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Solution 7.4 


1. Is there anything special about the ducky that causes it to right itself? (aka to not fall over) 
Compare the ducky against this “top-heavy” body (Fig. 7.12). Does the top-heavy body right 
itself? Give an explanation in terms of the CG and contact point. 


(a) The geometry of the ducky is such that its contact point moves faster than its CG as it 
rotates through angles ¢. This means the contact point automatically moves to apply 
a “righting moment”—a moment (torque) that “corrects” the rotation of the ducky and 
moves it back towards ¢ = 0. The top-heavy body has its contact point move slower 
than its CG as ¢ increases; this leads to a destabilizing moment that tends to topple the 
object. 


2. The previous question reveals that in order to solve the ducky problem, we'll need to be able 
to compute the CG and contact point. Conceptually, how would you compute the center of 
mass (CG) of the ducky? (You'll do this numerically in tonight’s homework using your boat 
code from last semester.) 


(a) This would be a double-integral over the area of the ducky; the integral would be a 
weighted average of position within the ducky, with a weight equal to the material 
density. Note that there is a separate double-integral for each component %oq, yoa. 


3. Conceptually, how would you compute the contact point of the ducky? Hint: Above you noted 
that the center of the circle (not the CG) remains a fixed distance r perpendicular away from 
the ground (tilted or not). 


(a) At 0 = 0 the height of the circle center is fixed at a distance r above the ground and at an 
angle ¢ from the vertical 7. We can use these two quantities in a triangle construction to 
arrive at Zcontact- For cases where 0 # 0 we could apply a coordinate transform to rotate 
this point by the ramp angle 6. 
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Homework 3: The Ducky Angle 
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You’re going to make use of your boat center of mass code from last semester in this homework. In case 
you had trouble with Homework 4 from the Fall, here’s a reminder that the solutions are available in Matlab 
Drive. 


8.1 Overview 


Exercise 8.1 


1. In order for the ducky to be in static equilibrium, the center of mass and contact point need to 
have some specified relationship. What is that relationship, and why is it necessary? 


2. How do the center of mass and contact point tend to change as you increase the roll of the 
ducky ¢? Do they change at the same rate, or does one move faster than the other? 
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8.2 Geometric Construction 


ya ra) 





Xcontact 


Figure 8.1: The ducky rolled to an angle ¢ relative to the ¥ axis. 


Exercise 8.2 


1. Compute the circle center cz, cy as function of ¢ within the x, y coordinate system. Hint: 
Remember from the day assignment that you have already determined the value of cy. 
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Figure 8.2: Triangle construction to find x-position of circle center. 


2. Study the schematic Figure 8.1 closely: What is the relationship between the contact horizontal 
position Xcontact and the center of the circle c,,? What is the yontact Value of the contact point? 


3. The center of mass remains at a fixed-distance from the center of the circle. Solve for the 
location of the center of mass «cq, ycg using Figure 8.5 in terms of this fixed distance d. Your 
solution should be a function of r, ¢, involve trigonometric functions, and should include the 
unknown constant d. 
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Kee Me on fact 


Figure 8.3: Schematic to construct the location of the CG rc@, yoa.: 





8.3. Center of Gravity 


Next, you will use what you learned from the Fall semester to compute the center of mass of the ducky, 
which will let you solve for the unknown parameter d. We will build on what you did in class and use a 
discrete approximation to the double-integral to compute xcq, ycq. Remember that solutions to the Fall 
homework are in Matlab Drive. 

As a brief reminder on how we tackled the boat center of mass problem in the fall: 


1. We set out to approximate the double-integral + [ [ p(7)dady asa summation + S>"_, 7p(7;)ArAy. 
2. We created a grid of points and filtered that grid based on two inequalities; a lower curve for the 
bottom of the boat y(a)poat < yi and an upper curve for the top of the boat y; < h. 


3. We computed the summation over only those points that met our filter condition (the inequalities 
above) to approximate the center of mass. 


We will apply the same approach to compute the center of mass (CG) in the local @, 9 coordinate system, 
then use that CG to compute the d parameter we introduced above. Once we have the value of d, we'll be 
well on our way to solving the ducky angle problem! 
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Figure 8.7: The circular segment “ducky.” We'll approximate the location of the CG and compute d as the 
distance between CG and the center of the circle. 


Exercise 8.3 


1. Remember that the ducky is defined by a circular segment with height h (Fig.8.7). What two 
inequalities in y must points inside the ducky satisfy? (You found the bottom curve in-class 
for the case ¢ = 0; use your results from that activity.) 


. Adapt your code from the Fall boat problem (See Matlab Drive for solutions!) to find the CG 
of the ducky. You will need to adapt the bounds in linspace and the inequalities for the 
insideBoat vector. Test your code with r = 6, h = 1; you should find that rcg = 0, ycog & 
0.6. 


+ Note: The purpose of this part of the HW is to get you to re-engage with your boat code 
from last semester. You will use this code again for the boat design project at the end of 
the module. We recommend making a copy of your boat code (or the solution code) and 
adapting it for the ducky problem. You should not have to make too many changes to 
compute the CG for the ducky! 


3. Use your CG code to compute d for the case where r = 6, = 2. Remember that d is the 
distance between the CG and the circle center. What is the value of d? 
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8.4 Transformation and Solution 





lcontact 


Figure 8.8: The ducky rolled to an angle ¢ on an inclined ramp with angle 0. 


Exercise 8.4 


. Write the vector location for the contact point and CG in the local x, y coordinate system. Both 
vectors Ucontact, local) UC'G,local Should be two-dimensional vectors. 


. Write down the rotation matrix Rramp(@) that will rotate the local coordinate system clockwise 
by an angle 6. (Note: The ordinary rotation matrix rotates a vector counter-clockwise. You will 
need to adapt this formula to rotate in the direction matching Figure 8.8.) 


. In Matlab, write code to use the local-coordinate vectors Scontact, local, UCG,local and matrix 
Ramp (9) to compute the global-coordinate vectors Gcontact, globals UCG, global- 


. In Matlab, write a function compute_arm(phi) that has hard-coded values for r, d, #, takes 
in the argument ¢, and returns the value tcontact — 1cG—the horizontal distance between the 
contact point and CG in the global coordinate system. 


. Compute the angle of the ducky ¢ when r = 6, h = 2,4 = 10°. Keep in mind the condition 
that we discussed above, and remember that the Matlab function £zero will find the root of 
a function; the point where f(a«*) = 0. 
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Solution 8.1 


1. In order for the ducky to be in static equilibrium, the center of mass and contact point need to 
have some specified relationship. What is that relationship, and why is it necessary? 


(a) For static equilibrium we must have the center of mass and contact point vertically aligned 
in the global coordinate system (note, not the ramp coordinate system). In the global 1, J 
coordinates, this corresponds to icg = ‘contact: Under this condition the contact forces 
can align with the center of mass so as to impose a zero net torque. Zero net torque is 
necessary for static equilibrium. 


2. How do the center of mass and contact point tend to change as you increase the roll of the 
ducky $? Do they change at the same rate, or does one move faster than the other? 


(a) Both xcq and “contact tend to increase as you increase ¢. However “contact tends to 
increase faster. 


Solution 8.2 


1. Compute the circle center cz, c, as function of @ within the x,y coordinate system. Hint: 


Remember from the day assignment that you have already determined the value of cy. 


(a) From the day assignment we know c, = r is constant. We can find from a simple triangle 
argument that c, = rtan(¢) + r¢. See Figure 8.4 for details. 
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Figure 8.4: Triangle construction to find x-position of circle center. 


2. Study the schematic Figure 8.1 closely: What is the relationship between the contact horizontal 
position Xcontact and the center of the circle c,,? What is the ycontact Value of the contact point? 


(a) The contact horizontal is identical to the circle center horizontal position; that is Xcontact = 
Cx = rtan(d). We also have Yyeontact = 0. 


3. The center of mass remains at a fixed-distance from the center of the circle. Solve for the 
location of the center of mass «cq, ycqg using Figure 8.5 in terms of this fixed distance d. Your 
solution should be a function of r, ¢, involve trigonometric functions, and should include the 
unknown constant d. 
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Figure 8.5: Schematic to construct the location of the CG xcq@, yoa. 


(a) We have tog = Xcontact — dsin(¢) = rtan(¢) — dsin(¢) & (r — d)¢é and you = 
r — dcos(@). 
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Figure 8.6: Triangle construction to find x and y position of the CG. Note that this is a function 
of ¢, and depends on a yet unknown quantity d. You'll solve for d in the next problem. 


Solution 8.3 


1. Remember that the ducky is defined by a circular segment with height h (Fig.8.7). What two 
inequalities in y must points inside the ducky satisfy? (You found the bottom curve in-class 
for the case ¢ = 0; use your results from that activity.) 


(a) Points inside the ducky satisfy r — Vr? — x? < yandy < h. 


2. Adapt your code from the Fall boat problem (See Matlab Drive for solutions!) to find the CG 
of the ducky. You will need to adapt the bounds in linspace and the inequalities for the 
insideBoat vector. Test your code with r = 6, h = 1; you should find that rog = 0, yog & 
0.6. 


« Note: The purpose of this part of the HW is to get you to re-engage with your boat code 
from last semester. You will use this code again for the boat design project at the end of 
the module. We recommend making a copy of your boat code (or the solution code) and 
adapting it for the ducky problem. You should not have to make too many changes to 
compute the CG for the ducky! 


(a) An implementation of this solution is available in this Matlab Drive folder; see 
duck_angle.mlx. 


3. Use your CG code to compute d for the case where r = 6, = 2. Remember that d is the 
distance between the CG and the circle center. What is the value of d? 
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(a) For r = 6,h = 2, the value is d = 4.8. 


Solution 8.4 


1. Write the vector location for the contact point and CG in the local x, y coordinate system. Both 
vectors Ucontact, local; UC'G,local Should be two-dimensional vectors. 


(a) The solution is 


rtan(@) | 


Dcontact, local = | 0 


rtan(d) — dsin(¢) 


UCG, local = | r— dcos(¢) 


(8.1) 


2. Write down the rotation matrix R,amp(@) that will rotate the local coordinate system clockwise 
by an angle 6. (Note: The ordinary rotation matrix rotates a vector counter-clockwise. You will 
need to adapt this formula to rotate in the direction matching Figure 8.8.) 


(a) The solution is 


(-6) —sin(—6) 
sin(-8) cos(6) C2) 


3. In Matlab, write code to use the local-coordinate vectors @contact, local; OCG, local and matrix 
Ryamp(9) to compute the global-coordinate vectors ®contact, global» UCG, global: 


(a) An implementation of this solution is available in this Matlab Drive folder; see 
duck_angle.mlx. 


4. In Matlab, write a function compute_arm(phi) that has hard-coded values for r, d, 0, takes 
in the argument ¢, and returns the value tcontact — 7cG—the horizontal distance between the 
contact point and CG in the global coordinate system. 


(a) An implementation of this solution is available in this Matlab Drive folder; see 
duck_angle.mlx. 


5. Compute the angle of the ducky ¢ when r = 6,h = 2,0 = 10°. Keep in mind the condition 
that we discussed above, and remember that the Matlab function £zero will find the root of 
a function; the point where f(a*) = 0. 


(a) An implementation of this solution is available in this Matlab Drive folder; see 
duck_angle.ml1x. The angle is ¢ ¥ 2.5°. 
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Week qa: Ducky Tipping Point, 
Stability 
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This week we’re going to use the ducky to understand fundamental ideas about stability. The ducky will 
give us an easy case to introduce stable and unstable equilibria. Ultimately we'll use these ideas to analyze 
and design stable boats. 


9.1 Ducky Tipping Point 


As a warmup, let’s think about the ducky (Fig. 9.1) once more. Answer the questions below. 


y 


é 





Figure 9.1: Remember the ducky! 
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Exercise 9.1 


1. Remind me briefly: For the ducky to be in static equilibrium, what relationship needs to exist 
between the contact point and the center of mass? 


2. There are at least three unique angles where the ducky can lay in static equilibrium. What are 
they? Sketch each case. 


3. One of the angles you identified is the “tipping point” of the ducky; the angle beyond which 
the ducky will tend to fall over. What is happening here—physically—that creates this tipping 
point? 


CO) 


9.2 Stable vs Unstable Equilibria 





In the previous section, we found equilibrium conditions. When these conditions are satisfied, the system 
has no net forces or torques, and is considered to be in equilibrium. However, equilibria can be of very 
different natures depending on how they respond to perturbations (small disturbances of the system). As an 
example, consider a ball sitting on a landscape as in Figure 9.2. In both the condition of the ball sitting at the 
very top of the hill, as well as the case of the ball sitting at the very bottom of a valley, the ball is at static 
equilibrium: the net force and torque on the ball is zero in both cases. However, the two situations respond 
very differently to perturbations: the ball at the bottom of the valley is stable to perturbations. The ball at 
the top of the hill is unstable to perturbations. Naturally for most engineering applications, we would prefer 
to be at a stable equilibrium than an unstable equilibrium! (Note, the concepts of neutral and metastable 
equilibria also exist.... feel free to read about these if you are interested). 


Ball at the top of a hill: Ball at the bottom of a valley: 
Unstable equilibrium Stable equilibrium 


Figure 9.2: Caption 


For the following scenarios, determine if the system is stable or unstable. 
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Exercise 9.2 


. A mass sitting at position xo and attached to a spring with force model Fring = —k(x — x9). 
Stable or unstable? 


. A person standing still on a completely round floating log. Stable or unstable? 


. A pendulum in a downward position (angle 6 = 0) where the torque due to gravity can be 
written T, = —mgL sin(@) (against the direction of rotation @). Stable or unstable? 


. A pendulum in an upward position (angle 6 = 180°) where the torque due to gravity can be 
written T, = —mgL sin(@) (against the direction of rotation 0). Stable or unstable? 
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9.3. Interpreting Graphs for Stability 


Above, you probability answered the exercise questions using intuition. Next we’re going to see how to 
determine whether an equilibrium is stable or unstable based on analysis. First, for a worked example, see 
Figure 9.3. 


-1.0 -0.5 0.0 0.5 1.0 
Displacement (m) 


Figure 9.3: Spring force against displacement. Note that as the displacement increases 6x = x — ry 
the force becomes increasingly negative, pushing dx \,. Correspondingly when 6x \, the force increases, 
pushing 62 7. When 6a = 0 the force is F' = 0. It is this effect of the spring force to restore the spring to 
dx = 0 that makes the equilibrium stable; this system has a restoring force. 


Next, you'll answer questions about the following torque vs angle graph (Fig. 9.4). 
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1.0 


0.5 


*m) 


0.0 


Torque (N 


-0.5 


-1.0 
90 0 90 180 270 360 450 
Angle (deg) 


Figure 9.4: Pendulum torque due to gravity against angle. Use this figure to answer the questions below. 


Exercise 9.3 
. Based on Figure 9.4, what angles are equilibria of this system? 


. Of the equilibria you identified, which are stable? How do you know this? 


. Of the equilibria you identified, which are unstable? How do you know this? 


. Look at the following image; how is this graph different from Figure 9.4? 
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90 180 270 
Angle (deg) 


5. Look at the same image in the previous problem; how would you determine the torque for 
6 <0? 


Exercise 9.4 


. Sketch the ducky’s net torque vs angle ¢ curve when it is on flat ground @ = 0. (Consider a 
case where h < r, but you need not worry about computing exact torques.) Show a range of 
angles from ¢ = 0° to a bit beyond the ducky tipping point. The following image shows a few 
suggested “key angles” to consider in your sketch. 


ST pead?e 


. Identify the stable and unstable equilibria based on your ducky torque curve. What is the slope 
of the torque curve at stable points? At unstable points? 


. The moment arm (sometimes called lever arm) is the perpendicular distance between a force 
applying a torque and its axis of rotation. Draw a moment arm r vs angle curve for the scenario 
above. Use a sign convention for r based on the diagram below. How do you determine stable 
vs unstable equilibria with this curve? (How does this differ from using the torque curve?) 
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Solution 9.1 


. Remind me briefly: For the ducky to be in static equilibrium, what relationship needs to exist 
between the contact point and the center of mass? 


(a) The center of mass (CG) needs to be directly above the contact point, in the global 
coordinate system. 


. There are at least three unique angles where the ducky can 


lay in static equilibrium. What are they? Sketch each case. 








































































































Unique angles include ¢ = 0° (upright), 6 = 180° (overturned), and @ > 90° (roughly 
@ & 100° in my sketch) where the ducky is at its tipping point. 


. One of the angles you identified is the “tipping point” of the ducky; the angle beyond which 
the ducky will tend to fall over. What is happening here—physically—that creates this tipping 
point? 


(a) The tipping point angle is the angle ¢ where the contact point is the corner of the ducky 
and the CG is directly above this contact point. Here, further rotation in ¢ will cause the 
CG to move beyond the contact point, applying a moment that will further rotate the 
ducky away from equilibrium. 


Solution 9.2 


. Amass sitting at position x9 and attached to a spring with force model Fypring = —k(x — x0). 


Stable or unstable? 

(a) Stable. 
. A person standing still on a completely round floating log. Stable or unstable? 
(a) Unstable. 


. A pendulum in a downward position (angle 9 = 0) where the torque due to gravity can be 
written T, = —mgL sin(@) (against the direction of rotation 0). Stable or unstable? 


(a) Stable. 


. A pendulum in an upward position (angle 6 = 180°) where the torque due to gravity can be 
written T, = —mgL sin(9) (against the direction of rotation 0). Stable or unstable? 


(a) Unstable. 


Solution 9.3 
. Based on Figure 9.4, what angles are equilibria of this system? 


(a) Equilibria include 6 = 0°, 180°, plus 360° duplicates. 
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2. Of the equilibria you identified, which are stable? How do you know this? 





(a) The equilibria 6 = 0° + n360° are stable. This is because positive perturbations to 0 
result in a negative torque, and vice versa. Thus these equilibria have a restoring torque. 


3. Of the equilibria you identified, which are unstable? How do you know this? 


(a) The equilibria 9 = 180° + n360° are unstable. This is because positive perturbations to 
6 result in a positive torque, and vice versa. Thus these equilibria do not have a restoring 


torque; the torque instead pushes them “away” from the equilibrium. 





4. Look at the following image; how is this graph different from Figure 9.4? 


0.5 


m) 


* 


0.0 


Torque (N 


-0.5 


-1.0 
0 90 180 270 360 
Angle (deg) 
(a) The graph is the same, except it is restricted to the domain @ € [0, +360°. 


5. Look at the same image in the previous problem; how would you determine the torque for 
6 <0? 


(a) The graph is periodic in 6 with period 360°; the behavior leading up to 0 360° is 
identical to the behavior at 0 7 0°. 


Solution 9.4 


. Sketch the ducky’s net torque vs angle ¢ curve when it is on flat ground 6 = 0. (Consider a 
case where h < r, but you need not worry about computing exact torques.) Show a range of 


angles from ¢ = 0° to a bit beyond the ducky tipping point. The following image shows a few 
suggested “key angles” to consider in your sketch. 


a 
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This is my sketch: 


Twa? 


\ 


on 


At small ¢ > 0, the torque 7 should be negative; it opposes the direction of motion. 


2. Identify the stable and unstable equilibria based on your ducky torque curve. What is the slope 
of the torque curve at stable points? At unstable points? The angles ¢ = 0° and ¢ = 180° are 
stable, these points have a negative slope in the torque curve. The unstable point is a little 
past @ = 90°; this point has a positive slope on the torque curve. 


3. The moment arm (sometimes called lever arm) is the perpendicular distance between a force 
applying a torque and its axis of rotation. Draw a moment arm r vs angle curve for the scenario 
above. Use a sign convention for r based on the diagram below. How do you determine stable 
vs unstable equilibria with this curve? (How does this differ from using the torque curve?) 


S 


_ 
- = = aoc & 


This is my sketch: 
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2 


With the moment arm curve, we are looking for a positive slope near the equilibrium, rather 
than a negative slope as with torque. 
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Week 4b: From Ducks to Boats 
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10.1 A prelude to boats 


The ducky tipping point introduced us to the concept of stability. Now we’ll transition to thinking about the 
stability of boats. Like with the ducky, there are two “important points” to track for boat stability; the center 
of mass and the center of buoyancy (COB). For a stable boat, we need the COB to move so as to generate a 
restoring moment that arrests rolling of the boat. However, this scenario is far more complicated than the 
duck, as the boat can also heave—it can move vertically in the water, which may cause the COB to move. 
We'll break these complex phenomena down into pieces and understand them bit by bit. 


0 V0) T 


Figure 10.1: An example boat at a few different heel angles. The center of mass is shown as a black circle, 
and the center of buoyancy is shown as a blue circle. 


Exercise 10.1 


1. As the example boat (Fig. 10.1) rotates away from a zero-heel angle (upright), what tends to 
happen to the center of buoyancy? 


2. For the rightmost boat in Figure 10.1, does the torque due to buoyancy tend to restore the boat 
to a zero-heel angle (upright)? How is this similar to the ducky? 
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3. For the example boat, somewhere between its upright orientation and its “on-its-back” orien- 
tation, there needs to be another point where the boat is in static equilibrium. What needs to 
be the case in this orientation? How is this “special” orientation different from the upright and 
“on-its-back” orientations? 


. The following is an example righting arm curve for a specific boat hull; it visualizes the moment 
arm (GZ) against boat heel angle (¢). The angle of vanishing stability (AVS) is denoted by 
the point D. What is the slope of the moment arm curve at the AVS, and why does this make 
physical sense? 


Deck edge 
immersion 


Angle of 
vanishing 


1 
i 
GMsing+t 1/2BMtan’osing stability 
' 
t 


we 57. 3°=1 rad 


Angle of max. 
stability 
Range of stablity 


Hakan Akyildiz Cemre Simsek CC 4.0, via Wikimedia 





There’s a subtle difficulty in computing a righting arm curve, which we'll get to soon. But first we need 
to learn the boatwright’s first rule... 


10.2 Boatwright’s First Rule 


There’s this classic Olin story about a design review involving Dave Barrett. A group of students had designed 
a boat and planned to load it with all kinds of fancy equipment. The students were excitedly describing all 
the fancy stuff they would do with their fancy equipment, when someone—a first-year—asked “You designed 
a boat—how do you know it will float?” 

The students replied “It’s a boat. Of course it will float.” Sensing a problem, Dave dug in, “No, that’s a 
good question. How do you know it will float? Have you done the math?” 

Sheepishly, the students admitted that no, they had not done the simple boat math to see if it would 
float. To their horror, when they did the math they realized their boat could not possibly carry all the fancy 
equipment they planned to load it with. Their boat would not float. 

This leads us to the first rule of boats: You have to answer the question: 
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Will it float? 


In the next exercise, you'll remind yourself of the conditions necessary for a boat to float, and some 
considerations about boat materials. 


Exercise 10.2 


. Both the ducky and a boat are subject to gravity. For both cases, what physical mechanism 
supplies the vertical force to counter gravity? 


. What must be true about an object in order for it to float? 


. The displacement ratio is the ratio of the mass of a boat over the maximum mass of water it 
can displace. What must be true about the displacement ratio of a boat in order for it to float? 


. Suppose you make a “boat” out of solid steel (with no gaps inside). Can this boat possibly float? 
Why or why not? 


. Suppose you make a boat out of steel, but allow for air gaps inside the boat (e.g. like Figure 10.2, 
but with a hollow hull under the water). What would you need to do to ensure a boat made 
from this material will float? 


. What is the density of wood? Why is this advantageous for building boats? 


. For the boat project, you will design your boat to be printed with a plastic filament with density 
= 1250kg/m°. What ramifications does this have for your boat design? 





Making our boat float is important. But we want to go beyond just building a boat that floats: We want 
to build a boat that is stable. In order to do this, we’ll need to answer a related question: 


What is the waterline of the hull in static equilibrium? 


This question introduces some new concepts: Heave is vertical motion of a boat. In static equilibrium a 
boat will tend not to heave: In equilibrium the distance between the waterline and the bottom of the hull is 
called draft, as seen in Figure 10.2. We call the line the water makes across a section of the hull a waterline. 
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Figure 10.2: Draft of a vessel. From seabornboats.com 


Why are these concepts important? As we'll see, in order to remain in (vertical) static equilibrium, the 
boat must heave as it rotates. This complicates the computation of the righting arm curve. We'll need to 
understand this complexity if we want to compute the AVS of a boat hull. 
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Consider the following shapes as the cross-section of a boat; that is, the boat is a prism extruded 
out-of-the-page with the given shape. Answer the following questions. 


Figure 10.3: Simple extruded (out-of-the-page) hull shapes made out of solid wood with density pPpoat = 





aq Pwater : 


Exercise 10.3 


. Sketch in the center of mass (CG) for each boat cross-section. 


. Sketch each boat at its upright heel and at equilibrium waterline. Keep in mind that pyoat = 
; Pwater, and each boat is a simple extrusion. How do you know the waterline is at that level? 


. Sketch the wide boat (first from left) and tall boat (second from left) at an angle of about 45°. 
Draw a waterline at the approximate equilibrium level, and depict the center of mass and 
center of buoyancy. How did you determine the equilibrium waterline? Which of the boats is 
stable about its upright heel? Which is unstable? 


. Next, assume each boat has enough ballast so that its center of mass is at its bottom surface. 
Sketch each boat cross-section again with its new center of mass. 


. For the new ballast boats, sketch each at its upright heel and at equilibrium waterline. Assume 
that each boat’s total weight is unchanged by the addition of ballast (i.e. we’ve changed the 
distribution of material to keep the total mass the same). 


. For the new ballast boats, sketch the wide boat (first from left) and tall boat (second from left) 
at an angle of about 45°. Draw a waterline at the approximate equilibrium waterline, and 
depict the center of mass and center of buoyancy. Which of the boats are stable in their upright 
position? Which are unstable? 





10.3 Righting Arm Curves 


We now have the language and concepts to discuss the righting arm curve properly: For a given boat, the 
righting arm curve is a plot of the moment arm due to the center of buoyancy, at a given heel angle ¢, 
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assu 


ming the ship is at its equilibrium waterline. Thus, to construct the righting arm curve, we have to follow 


a multi-step process: 


1 


2. 


3. 


4. 


. Rotate our boat to a desired heel angle ¢. 


Determine the waterline necessary for vertical static equilibrium (where weight equals buoyant force) 
at the given heel ¢. 


Compute the righting arm for the given heel ¢. 


Repeat for different heel values ¢ until satisfied. 


As we've seen above, the righting moment curve allows us to determine the AVS of a given boat design. 
In the homework you will build the computational tools necessary to compute a righting moment curve 


Exercise 10.4 


1. Sketch a righting arm curve for the ‘wide’ boat. What is the AVS for this shape? 


2. Sketch a righting arm curve for the ‘tall’ boat. Compare it with your curve for the ‘wide’ boat. 





a) 


10. 


4 (Optional) Challenge Problem 


If you're looking for a challenge, try the following exercise! 


Exercise 10.5 


1. (Optional) Sketch a righting arm curve for the box-shaped boat with displacement ratio 0.25. 
Note: This case is very tricky! 


2. (Optional) Draw the box-shaped boat at its stable heel angle. 
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Solution 10.1 


1. As the example boat (Fig. 10.1) rotates away from a zero-heel angle (upright), what tends to 
happen to the center of buoyancy? 


(a) The center of buoyancy tends to move horizontally, so as to apply a torque to the boat. 


2. For the rightmost boat in Figure 10.1, does the torque due to buoyancy tend to restore the boat 
to a zero-heel angle (upright)? How is this similar to the ducky? 


(a) No, for the rightmost case the buoyant force tends to apply a torque that restores the 
boat to an upside-down orientation. This is similar to the duck in that the boat can tip 
over and settle on its back. 


3. For the example boat, somewhere between its upright orientation and its “on-its-back” orien- 
tation, there needs to be another point where the boat is in static equilibrium. What needs to 
be the case in this orientation? How is this “special” orientation different from the upright and 
“on-its-back” orientations? 


(a) The “tipping-point” angle for the boat is in static equilibrium; therefore the boat center 
of mass is directly above the center of buoyancy (in the global coordinate system). This 
orientation differs from the upright and overturned angles because it is an unstable 
equilibrium; beyond this angle (increasing the heel further) will lead to a non-restoring 
torque. This “special” angle is called the angle of vanishing stability (AVS). 


4. The following is an example righting arm curve for a specific boat hull; it visualizes the moment 
arm (GZ) against boat heel angle (#). The angle of vanishing stability (AVS) is denoted by 
the point D. What is the slope of the moment arm curve at the AVS, and why does this make 
physical sense? 
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Hakan Akyildiz Cemre Simsek CC 4.0, via Wikimedia 


(a) The slope is negative at the AVS. This makes physical sense because under our sign 
convention, a positive moment arm corresponds to a restoring torque towards ¢ = 0°. 
Beyond the AVS the buoyancy-applied torque pushes the boat away from ¢ = 0° and 
towards ¢ = 180°. 
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Solution 10.2 


1. Both the ducky and a boat are subject to gravity. For both cases, what physical mechanism 
supplies the vertical force to counter gravity? 


(a) The ducky experiences a normal force that keeps it from falling (this is due to contact 
with the ground), while a boat experiences buoyancy (this is due to pressure supplied by 
the surrounding fluid). 


2. What must be true about an object in order for it to float? 


(a) In order to float, an object must displace a volume ¥ such that the weight of the displaced 
water equals its own weight F, = pwaterg¥ = W. 


3. The displacement ratio is the ratio of the mass of a boat over the maximum mass of water it 
can displace. What must be true about the displacement ratio of a boat in order for it to float? 


(a) In order for a boat to float, its displacement ratio must be less than one. 


4. Suppose you make a “boat” out of solid steel (with no gaps inside). Can this boat possibly float? 
Why or why not? 


(a) A boat made out of solid steel could not possibly float. Steel has a density of ~ 8000kg/m°, 
which is more than eight times that of water 1000kg/m°. Regardless of the volume that 
solid steel displaces, it will sink. 


5. Suppose you make a boat out of steel, but allow for air gaps inside the boat (e.g. like Figure 10.2, 
but with a hollow hull under the water). What would you need to do to ensure a boat made 
from this material will float? 


(a) You would need to ensure the volume of displaced water is sufficient to support the total 
mass of the boat; i.e. displacement ratio less than one. You could do this by enclosing a 
volume of air with thin steel, which would reduce the “effective” density of the total boat 
volume. Note that modern battleships are built of steel; this is a proven boat design. 


6. What is the density of wood? Why is this advantageous for building boats? 


(a) Density of wood varies quite a bit by species! The Engineering ToolBox lists densi- 
ties for numerous wood species. For instance, oaks have a density in the range of 
(600, 900]kg/m°. Any of these oak varieties would be advantageous for a boat; their 
density is less than water, so we could potentially build a solid hull and still have positive 
buoyancy. 


7. For the boat project, you will design your boat to be printed with a plastic filament with density 
~ 1250kg/m°. What ramifications does this have for your boat design? 


(a) This material is more dense than water, so you can’t make your boat design solid. You 
will either need to include an air gap inside the boat, or vary the print infill to reduce the 
density of the material. 


Solution 10.3 


1. Sketch in the center of mass (CG) for each boat cross-section. 
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2. Sketch each boat at its upright heel and at equilibrium waterline. Keep in mind that ppoat = 
; Pwater, and each boat is a simple extrusion. How do you know the waterline is at that level? 


ae Ha 


a | ~ M4 aw 


Each boat displaces a volume of water equal to 1/4 of its total volume. 


3. Sketch the wide boat (first from left) and tall boat (second from left) at an angle of about 45°. 
Draw a waterline at the approximate equilibrium level, and depict the center of mass and 
center of buoyancy. How did you determine the equilibrium waterline? Which of the boats is 
stable about its upright heel? Which is unstable? 
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Wid ¢ 7, / 


Ss #2 


The equilibrium waterline is where a quarter of the boat’s volume is underwater (see above). 


The ‘Wide’ boat is stable, while the ‘Tall’ boat is unstable. 


4. Next, assume each boat has enough ballast so that its center of mass is at its bottom surface. 


Sketch each boat cross-section again with its new center of mass. 


5. For the new ballast boats, sketch each at its upright heel and at equilibrium waterline. Assume 
that each boat’s total weight is unchanged by the addition of ballast (i.e. we’ve changed the 
distribution of material to keep the total mass the same). 
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The waterlines are unchanged: Each boat still displaces a volume of water equal to 1/4 of its 
total volume. 


6. For the new ballast boats, sketch the wide boat (first from left) and tall boat (second from left) 
at an angle of about 45°. Draw a waterline at the approximate equilibrium waterline, and 
depict the center of mass and center of buoyancy. Which of the boats are stable in their upright 
position? Which are unstable? 





Now both the wide and tall boats are stable in their upright position. 


Solution 10.4 


1. Sketch a righting arm curve for the ‘wide’ boat. What is the AVS for this shape? 
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Shape: Wide 
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The shape can be in equilibrium at ¢ = 90°, but the slope is negative at this point so this is 
the AVS. 


2. Sketch a righting arm curve for the ‘tall’ boat. Compare it with your curve for the ‘wide’ boat. 
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Shape: Tall 
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The ‘tall’ boat’s curve should look familiar; it’s nothing more than a phase-shifted version of 
the ‘wide’ boat! Put differently, the tall boat is just the wide boat on its side. 


Solution 10.5 


1. (Optional) Sketch a righting arm curve for the box-shaped boat with displacement ratio 0.25. 
Note: This case is very tricky! 
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Shape: Box 
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Note that the box hull is not stable around ¢ = 0°, nor around ¢ = 45°. Instead it is stable at 
26:5" 





2. (Optional) Draw the box-shaped boat at its stable heel angle. 
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Box: Waterline 
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Homework 4: Analyzing Boat Stability 





Contents 
11.1 Infill, Ballast, and Waterlines ...... 0.0... 2. ce ee ee ee ee ee es 109 
11.2 Complete the Righting Arm Code ....... 0.0... 0.0... cee eee ee eens 110 
11.3 Analyze the Triangle Boat... 1... ee ees 110 





You're going to make use of your boat center of mass code from last semester in this homework. In case 
you had trouble with Homework 4 from the Fall, here’s a reminder that the solutions are available in Matlab 
Drive. 


11.1 Infill, Ballast, and Waterlines 


Through the following exercise you will build up your own analysis code. Remember that you can use the 
Fall Homework 4 solution in Matlab Drive as a starting point. This exercise will also help you connect 3d 
print infill to the concept of ballast; you can use these ideas in your own boat design! 


Exercise 11.1 


1. In your own words, what is infill in the context of 3d printing? How could you use the concept 
of infill to add ballast to your boat? 


. Modify your boat code to allow for a variable density of the hull. Use a base den- 
sity of rho100 = 1250 (the density of the 3d print filament, in kg/m), a 50% infill 
density of rho50 = 0.5 * 1250, and combine these quantities in a piecewise 
density function fun_rho = @(y) rhol100 * (y < h) + rho50 * (y >= h). 
Use this function to replace the density in the line 
masses = insideBoat .* fun_rho(P(2, :)') * deltaA * L. Test your 
code with boat shape 2 with W = 1.0; D = 0.5; L = 0.6. Ath = 0.6 you should 
find CoM = [0.0; 0.3015],andath = 0.2 youshould find CoM = [0.0; 0.2652]. 
Describe—in your own words—how the parameter h allows you to vary the ballast of the boat. 


. For the boat with piecewise infill, use the sum of the masses to compute the mass_boat, and 
compute a vector of masses_water based on the density of water (rho_water) to compute 
mass_water (the mass of the maximum displaced water). Use these two quantities to compute 
displacement_ratio = mass_boat / mass_water. What is the displacement ratio 

for the case where W = 1.0; D = 0.5; L = 0.6; h = O.2? Can this boat float? 


4. Suppose you wanted to 3d print a boat with a displacement ratio of 0.25 with a fixed infill 





112 


CHAPTER 11. HOMEWORK 4: ANALYZING BOAT STABILITY 113 


percentage across the boat. Approximately what infill percentage would be necessary? Neglect 
the fact that the walls are solid and of finite thickness. 


. Modify your boat code to set the waterline at a distance d above z = 0 and compute the mass 
of the displaced water. Use the boolean vector underWaterAndInsideBoat to create a 
vector of submerged masses. Continue touseW = 1.0; D = 0.5; L = 0.6; h = 0.2. 
Compute the difference of the boat mass minus the mass of the displaced water mass_diff 
for distanced = 0. 2. Is this above, below, or at the equilibrium waterline? 


. Modify your boat code to first rotate the boat, set a waterline offset d, then compute the 


mass_ diff. Continue to useW = 1.0; D = 0.5; L = 0.6; h = 0.2. What is the 
mass difference for heel angle ¢ = 90°? 


. Explain conceptually how you would use the Matlab routine £zero to find the value of the 
waterline offset d where mass_diff is zero for a specified heel ¢. Why is finding this point 
d important? 





Solutions for this exercise are in this Matlab drive folder in the file solutions_e11p1.mlx. 


11.2 Complete the Righting Arm Code 
For the next exercise you will work from an existing righting arm code. From this Matlab drive folder 


download boat_analysis_assignment .mand modify the code to complete the following. 


Exercise 11.2 


1. Complete the boat_analysis_assignment .m analysis code by implementing the buoy- 


ancy function at the bottom of the file. Note that there is no solution file for this task: You 
should be able to do this using techniques you learned in the previous parts. 


Ca) 





11.3 Analyze the Triangle Boat 





For the following exercise, use your righting arm code to analyze the case where W = 4, H = 2,1 
10,n = 1. This will give a triangular hull, as shown in Figure 11.1. 
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Figure 11.1: Triangular hull at a small heel angle. 


Exercise 11.3 


1. Set dispratio = 0.30 and generate a righting arm curve. What is the AVS for this hull? 


2. Setdispratio = 0.20and generate a righting arm curve. Is this hull stable at heel ¢ = 0°? 
Why or why not? 


0.25 and generate a righting arm curve. Is this hull stable at heel ¢ = 0°? 


3. Setdispratio = 
Why or why not? 
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Solution 11.1 


1. In your own words, what is infill in the context of 3d printing? How could you use the concept 
of infill to add ballast to your boat? 


(a) Infill is the interior print pattern that fills the structure. It allows the interior of a 3d 
printed part to be nearly hollow while having solid walls. You can add ballast to your boat 
by making the infill pattern more dense near the bottom of the boat, and more sparse 
towards the deck. 


2. Modify your boat code to allow for a variable density of the hull. Use a base den- 
sity of rho100 = 1250 (the density of the 3d print filament, in kg/m), a 50% infill 


density of rho50 = 0.5 * 1250, and combine these quantities in a piecewise 
density function fun_rho = @(y) rhol00 * (y < h) + rho50 * (y >= h). 
Use this function to replace the density in the line 
masses = insideBoat .* fun_rho(P(2, :)') * deltaA * L. Test your 


code with boat shape 2 with W = 1.0; D = 0.5; L = 0.6. Ath = 0.6 you should 
find CoM = [0.0; 0.3015],andath = 0.2 youshould findCoM = [0.0; 0.2652]. 
Describe—in your own words—how the parameter h allows you to vary the ballast of the boat. 


(a) Increasing h makes a larger fraction of the bottom of the boat heavier; this increases the 
ballast. See the solution for an implementation of this work. 


3. For the boat with piecewise infill, use the sum of the masses to compute the mass_boat, and 
compute a vector of masses_water based on the density of water (rho_water) to compute 
mass_water (the mass of the maximum displaced water). Use these two quantities to compute 
displacement_ratio = mass_boat / mass_water. What is the displacement ratio 
for the case where W = 1.0; D = 0.5; L = 0.6; h = O.2? Can this boat float? 


(a) For the case where W = 1.0; D = 0.5; L = 0.6; h = 0.2 we have 
displacement_ratio = 0.7813. Since the displacement ratio is less than 
one, this boat will float. See the solution for an implementation of this work. 


4. Suppose you wanted to 3d print a boat with a displacement ratio of 0.25 with a fixed infill 
percentage across the boat. Approximately what infill percentage would be necessary? Neglect 
the fact that the walls are solid and of finite thickness. 


(a) The displacement ratio is Whoat/Wwater = Pboat /Pwater- Therefore we need the effective 
density of the boat to be 25% that of water. Setting this yields ppoar = 0.25Pwater = 
250kg/m* = 0.2pslament- 


5. Modify your boat code to set the waterline at a distance d above z = 0 and compute the mass 
of the displaced water. Use the boolean vector underWaterAndInsideBoat to create a 
vector of submerged masses. Continue touseW = 1.0; D = 0.5; L = 0.6; h = 0.2. 
Compute the difference of the boat mass minus the mass of the displaced water mass_diff 
for distanced = 0. 2. Is this above, below, or at the equilibrium waterline? 


(a) With distance d = 0.2 the draft is far less than the equilibrium draft; the equilibrium 
draft is around 0.425. See the solution for an implementation of this work. 


6. Modify your boat code to first rotate the boat, set a waterline offset d, then compute the 
mass_diff. Continue to useW = 1.0; D = 0.5; L = 0.6; h = 0.2. What is the 
mass difference for heel angle ¢ = 90°? 


(a) With distanced = 0.2 at heel angle 6 = 90°, mass_diff = -0.9336; this is near 
the equilibrium condition. See the solution for an implementation of this work. 


7. Explain conceptually how you would use the Matlab routine £zero to find the value of the 
waterline offset d where mass_diff is zero for a specified heel ¢. Why is finding this point 
d important? 
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(a) You could write a function that assumes a heel angle ¢ and takes d as an argument, 
computes the mass of the displaced water based on the proposed waterline, and returns 
the difference in displaced water mass and total boat mass. Passing this function to 
£zero will search for the waterline d that corresponds to vertical static equilibrium. 
This process is important because the righting arm curve is based on the moment arm of 
buoyancy at equilibrium draft; finding the correct d gives the correct center of buoyancy 
for this calculation. 


Solution 11.2 


1. Complete the boat_analysis_assignment .m analysis code by implementing the buoy- 
ancy function at the bottom of the file. Note that there is no solution file for this task: You 
should be able to do this using techniques you learned in the previous parts. 


(a) You can do it! 


Solution 11.3 
1. Setdispratio = 0.30 and generate a righting arm curve. What is the AVS for this hull? 


(a) The AVS is just above 100°. 
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2. Setdispratio = 0.20 and generate a righting arm curve. Is this hull stable at heel ¢ = 0°? 
Why or why not? 


(a) This hull is not stable at ¢ = 0°; note that the slope of the moment arm curve is negative 
at @ =°. This boat has a finite angle of loll. 
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3. Setdispratio = 0.25 and generate a righting arm curve. Is this hull stable at heel ¢ = 0°? 
Why or why not? 


(a) This hull is not technically stable at 6 = 0° as it does not provide a restoring torque. 
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12.1 Boat Design Project 


In this partner project you will design a monohull boat, use mathematical analysis to inform your design, 
and generate detailed design documents and implementation in SolidWorks to handoff your design to be 
manufactured. You will use multi-variable calculus and statics concepts (what we’ve covered in class) to 
design a boat that meets quantitative stability criteria, and will later have a chance to physically validate 
your design. 
12.1.1 Objectives 
As a result of this project, it is our hope that you will: 

1. Design a small boat that meets specific, quantitative performance requirements. 

2. Design a small boat that is manufacturable, and have it manufactured successfully by a third party. 


3. Use quantitative analysis to inform your boat design. 


4. Communicate the intent of your boat design and the rationale behind your design decisions. 


12.1.2 Do 


In order to accomplish this project, you will have to: 


1. Conduct background research. 
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Perform back-of-the-envelope calculations to inform your initial design. 


Iteratively design your boat and compute a detailed analysis to ensure that design meets the project 
requirements. 


(a) You may use the 2d righting arm curve code we provided 
(b) You may also use Paul Ruvalo’s boat simulator (for 3d work) 


(c) Or you can write your own code (danger zone!) 


Communicate your boat design and analysis in such a way that another student could build your 
design and understand its intent. 


Handoff your boat design in the form of a 3d print-ready STL file. 


12.1.3 Produce 


To complete this project, you will have to make: 


1 


2 


3 


4 


- ( 
- ( 
- ( 
- ( 


Team) Handoff package: STL file and 3d print instructions 
Team) Design report: Calculations and rationale 
Team) 20 second video about your boat! 


Individual) Reflection 


12.2 Detailed requirements 


This section provides specific details on the project requirements. 


12.2.1 Boat design requirements 


1. 


2. 


The boat must fit within a 6” x 6” x 3” volume (for 3d print build plate / volume). 


The boat must be created from an equation-driven CAD model. See this guide for details on how to 
build your CAD for export to the simulator and tips for building your CAD model. 


The boat must be a monohull displacement design (no outriggers or catamarans). 
The boat must have a flat deck; it cannot have a mast. 


You must get your boat design checked off by a CA before submission. This is to ensure your boat is 
manufacturable. 


12.2.2 Performance requirements 


You may simulate the boat’s performance characteristics as much as you want. By the end of the semester 
you will have the opportunity to compare physical measurements of the boat’s performance characteristics 
against your simulation / analysis results. 


The boat must satisfy the following requirements: 


1. 


2. 


3. 


The boat must float. 
In equilibrium, the deck of the boat should be parallel to the surface of the water (off by < 5 degrees). 


The angle of vanishing stability (AVS) for the boat must be between 120 degrees and 140 degrees. 


Boat professionalism requirements 


¢ The boat must look professional. 


« The handoff package must be identical to the design presented and analyzed in your report. 
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12.2.3. (Deliverable, Team) Handoff Package (Due midnight 3/14) 


1 


2 


3 


. STL file for print geometry 
. Instructions (if any) for how infill percentage should change over the print volume 


. Minimal bounding box for the boat geometry (used for print estimation) 


» Bg. 3"x3"xa” 


12.2.4 (Deliverable, Team) Design report (Due midnight 3/14) 


To make the design report simple to complete, the report requirements are very specific. 
Your report must include 4 figures: 


1 


2 


3 


4 


. A 3-dimensional view of the boat (your choice of angle). 


. A cross-sectional view of the boat at midship, heel of o degrees with the waterline, at equilibrium 
heave, with the COM and COB clearly denoted. 


. Across-sectional view of the boat at midship, heel at the AVS with the waterline, at equilibrium heave, 
with the COM and COB clearly denoted. 


. A graph depicting the (computed) righting moment arm versus heel angle of the boat, from o degrees 
to 180 degrees. 


For each of the figures, you must write a caption that answers the following questions: 


1. 


What is your overall design? Is it a simple extrusion, or do you use lofts to taper the fore and aft of 
the vessel? What is the percent infill of the 3d print? Is it constant, or does it vary with the vertical 
position? 


. What is the displacement ratio of your boat? How does this indicate that your boat will satisfy Perfor- 
mance Requirement 1 (boat floats)? How did you tweak your boat’s design to meet this performance 
requirement? 


. How can you tell that this is an equilibrium heel of the boat? 


. How does this curve indicate that your boat will satisfy Performance Requirement 2 (floats upright)? 
What is the AVS? How does this indicate that your boat will satisfy Performance Requirement 3 (AVS 
between 120 and 140 degrees)? How did you tweak the shape of your boat’s hull to achieve both 
performance requirements (2 and 3)? 


12.2.5 (Deliverable, Team) Short Video (Due midnight 3/14) 


This 


is the end of the Boats module! We want you to make a short video about your boat to celebrate! We 


will play some of the videos in-class on 3/15. Your video must satisfy the following requirements: 


1 


2. 


. Total video length < 20 seconds (hard stop!) 
Your video must be fun (mandatory) 


Your video should convey the spirit that your boat is awesome, and you should be super-proud of your 
boat. 


You may not make memes of Zach, nor Mark, nor Melinda. 


You must not spend more time on your video than on your boat.... 


12.2.6 (Deliverable, Individual) Reflection (Due midnight 3/14) 


You 


will also have to complete an individual reflection after you complete your boat project. This will be 


detailed elsewhere. 


Part II 


Robo: Curves, Outliers, and 
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13.1 Technology Setup 


We will be working with the NEATO BotVac as a way to physically validate concepts and calculations during 
this module. Programming and running experiments with the NEATO robots can be done with both physical 
robots and using the robot simulator. For the Spring 2021 version of QEA2z, we will be using the robot 
simulator throughout the module. The setup steps on the Meeto Your Neato page must be completed before 
using the simulator. NOTE: The simulator is regularly updated and the workflow refined, so all students 
should complete these steps to ensure they have the most recent version. 


13.2 Robo Ninja Warrior 


Welcome to Module 3 entitled “Robo Ninja Warrior.” In this module you'll be learning some of the fundamental 
ideas, concepts, and algorithms that lie at the heart of robotics. Along the way we'll be revisiting some 
mathematical and analytical concepts we touched upon earlier in the semester. Not only will we be applying 
these concepts in new contexts and to new purposes, but also extending them in important ways. The 
module is structured around a series of challenges in which you will be programming your robot to perform 
various tasks autonomously. As you and your robot face tougher and tougher challenges, you will need to 
carefully integrate a wider range of techniques in order to successfully complete the task at hand. 

When we typically do this module, we use the Neato BotVac as our robot platform (you'll learn more 
about the platform soon, but briefly it is a really nice robot platform that has some very advanced sensors). 
Of course we are now separated from our beloved Neatos, but never fear! The QEA team has got you covered. 
In this module we'll be using a Neato simulator, and we are excited about some of the cool things we'll be 
able to do when working in simulation. You'll learn more about the Neato on the Meeto Your Neato page. 
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13.3. Demonstration of Robot Simulator 


The robot simulator developed for QEA allows a user to command the wheel velocities of their virtual robot, 
interact with outputs from the bump and LIDAR sensors, and measure motion using the wheel encoders. The 
videos below demonstrate the virtual robot tackling two of the challenges you will encounter in this module. 


1. The Bridge of Doom: In the bridge of doom challenge, you will need to program your robot to 
carefully traverse a bridge defined by a parametric curve. Program your robot incorrectly and it will 
plunge into a (virtual) lava pit! A great example of this challenge is here. 


2. The Gauntlet: In the Gauntlet challenge, you will navigate a cluttered environment using the data 
form your robot’s LIDAR sensor. A succesful navigation of the Gauntlet can be viewed here. 


13.4 What is a Robot? 


Before diving into the challenges, let’s take a step back and look at some definitions of the word “robot”. 
Merriam-Webster provides three definitions of the word. 


» a machine that looks like a human being and performs various complex acts (such as walking or 
talking) of a human being 


+ a device that automatically performs complicated often repetitive tasks 


+ a mechanism guided by automatic controls 





Figure 13.1: Left: C-3PO from the Star Wars franchise. Right: Johnny Five from the Short Circuit movies. 


Exercise 13.1 


Jot down a list of devices. For each device, determine which, if any, of the three definitions of the 


word “robot” apply. 





These disparate definitions highlight the fact that depending on who you ask, the answer to the question 
“what is a robot?” will likely be very different. In a sense these three definitions proceed along a continuum 
of more restrictive to looser definitions, with the definition “a mechanism guided by automatic controls” 
being the loosest. Under this definition many things that you probably wouldn’t intuitively call “robots” 
are just that. Take for example a thermostat. A thermostat is a mechanism that automatically regulates 
the heat in a building by comparing the measured temperature with a “desired” temperature. By the third 
definition, a thermostat is certainly a robot. At this point you may be thinking that if something as simple 
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as a thermostat is a robot, then definition 3 must be completely bogus. After all, robots are supposed to be 
complicated and hard! However, today we will see that robots can in fact be quite simple. Further, simple 
robots can do some pretty complicated things. 


13.5 Sensory-Motor Loops 
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Figure 13.2: A schematic of a robot controlled by a sensory-motor loop. 


We ended our last section on a somewhat cryptic note. If we seek to design simple robots, how on earth 
can they do complex things? The answer to this question lies in the fact that robots are not isolated machines, 
but instead interact with a complex and ever-changing world. A simple model that captures this idea is the 
sensory-motor loop (see Figure 13.2). The model situates the robot within an environment that it interacts 
with through two pathways. 

The first is a motor pathway by which the robot executes actions which affect its environment. In our 
thermostat example these actions would be turning the heating system on or off. In a more conventional 
example of a robotic arm in a manufacturing plant, this could be operating the motors that control the joints 
of the arm. 

The second is a sensory pathway by which the robot perceives its environment. In our thermostat 
example this could be a temperature sensor such as a thermocouple. In the case of a robotic arm in a 
manufacturing plant, this could be a potentiometer that measures the angle of each of the arm’s joints or 
pressure sensors that measure contacts between the robot arm and other objects. 

The ”brain” of the robot, if you will, is defined by the box labeled “behavior system”. In the general 
case you could imagine that the robot’s brain might integrate multiple pieces of sensory information over 
time to form representations of the world around it. Take for example a robot mapping a building. The 
robot could build a progressively more detailed map by moving around in the building and collecting sonar 
readings (which provide an estimate of distance to objects in the world) over time. Putting aside this more 
complex form, let’s restrict ourselves to robots with fairly simple behavior systems. What about a robot 
that has no memory at all? Such a robot would have to make all of its decisions based on its current 
sensory information. 


Exercise 13.2 


Design robots using the model in Figure 13.2. Restrict yourselves to robots that have no memory (i.e. 
ones that act at any moment in time directly based on their sensory input). To help get your creative 
juices flowing, it may help to make lists of sensors and actuators. You can then create interesting 
ideas by seeing what would happen if you paired a particular sensor with a particular actuator in a 
particular context. Don’t worry too much about trying to design useful robots (whimsical is good), 
the goal here is to be creative and to think through the mental simulations necessary to understand 
how your robot would behave. Here are some suggestions for sensors and actuators. 

Sensors: vibration sensor, microphone, camera, thermal camera, wheel rotation sensor, pressure 
sensor, light intensity sensor, laser range sensor, bump detector, temperature sensor, breathalyzer, 
etc. (Wikipedia has a good list). 

Actuators (which is just a more general term for something that causes an action, e.g., a 
motor): DC motors, combustion engines, stepper motors, solenoids, speakers, lasers, LEDs, etc. 
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13.6 Grey Walter’s Tortoises 


Two very early examples of electric robots that worked using the principle of sensory-motor mappings were 
Grey Walter’s robotic “Tortoises” Elmer and Elsie (see left panel of Figure 13.3). This YouTube video probably 
tells the story better than we possibly could. 

As Grey Walter said himself, the robots behave as if they had a very simple two-cell nervous system that 
specifies the sensory-motor mapping (or behavior system). Despite this striking simplicity, the robots are 
capable of complex behavior such as obstacle avoidance and phototaxis (navigating towards the light that 
marks the charging kennel). This is an example of what we’ve been alluding to several times in this document: 
simple sensory-motor mappings can lead to complex behavior when put into a complex environment. 


13.7 Braitenberg Vehicles 


The pioneering work of Grey Walter was extended by a number of others. One particularly interesting line 
of research was conducted by Valentino Braitenberg. Valentino Braitenberg was interested in how vehicles 
controlled by very simple sensory-motor loops could execute behaviors that when viewed by humans would 
cause them to ascribe emotion and feelings of intelligence and intentionality to these vehicles. The name 
typically used to refer to these hypothetical robots is “Braitenberg Vehicles”. While Braitenberg never 
actually built these vehicles (he was more interested in how these simple vehicles might inform various 
philosophical issues, particularly in the area of philosophy of mind), others have followed up and actually 
built these vehicles. Here is a video from a group at MIT that built several of Braitenberg’s vehicles. 
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Figure 13.3: Left: Gray Walter’s Tortoise Elsie. Right: A schematic of the vehicle from the real-life 
Braitenberg vehicles video. The robot is a differential drive vehicle with two wheels. We use Vz; and Vr to 
refer to the velocities of the left and right wheels (positive is forward by convention). Also labeled are the 
other sensors on the robot, including the light sensor that reads higher values when exposed to more light, a 
whisker sensor that reads o when it is not in contact with something and 1 if it is, and two bump sensors 
that read 1 when they hit something and o otherwise. 


A schematic of the vehicle (or robot) in the video is shown in the right panel of Figure 13.3. The robot 
has two motors that each control one of the robot’s wheels. We can use the symbols Vz, and Vp to refer to 
the velocities of each of the wheels (positive indicating a forward velocity). Using the framework from the 
previous section, these are our actuators. The robot also has a number of sensors. A light sensor outputs a 
continuous value which reads out larger values when in the presence of bright light and smaller values in 
the presence of low light (this is basically a one-pixel camera!). Additionally the robot has two bump sensors 
that have binary outputs. That is, they output 1 when they strike an object and o otherwise. Finally, the 
robot has a whisker sensor that is also binary and outputs a 1 when it contacts something and o otherwise. 
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Before getting on to the task of figuring out how one might program this robot, we need to understand a 
bit about how the drive systems of these robots work. The configuration shown in Figure 13.3 is known as 
differential drive. We will be thinking much more systematically about differential drive in the first robot 
challenge, but for now let’s work to understand it from a qualitative perspective. 


Exercise 13.3 

To build a qualitative understanding of differential drive it helps to understand a few limiting cases. 
Good ones to start with are ones that involve the wheels moving at equal speeds in either the 
forward (positive) or reverse (negative) direction. In these cases the robot will either move forward 
in a straight line or backwards in a straight line. In these cases the speed of the robot is directly 
proportional to the speed of its wheels. Now, let’s consider cases where the velocities of the two 
wheels are unequal. To help you with your intuition it might help to imagine the right wheel pulling 
either forwards or backwards on the right side of the robot and the left wheel pulling either forwards 
or backwards on the left side of the robot. Here is a potential list of limiting cases to consider. Make 
predictions about what would happen in these cases. It may help to sketch a couple of key frames 
(poses of the robot) over time. 


. What if Vz is positive and Ve = —Vz,? 
. What if Vp is positive and Vp = —VpR? 
. What if V_ = 0 and Vp is positive? 

. What if Ve = 0 and V_ is positive? 

. What if V_ = 0 and Vp is negative? 

. What if Vp = 0 and Vz, is negative? 


. What if Vp is positive and V;, = 4 


. What if Vz is positive and Ve = zu 
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Solution 13.1 


Here are a few examples to get you started. 


A thermostat (2) and (3) 

R2Dz2 (3) (maybe also (2)?) 

A toaster oven (2) (most toasters don’t really have a true control system) 
C3PO (1) and (3) 


Spot from Boston Dynamics (3) (maybe (2)?) 


Solution 13.2 


Sorry, no solution here! You all will come up with cooler things than we ever could. 


Solution 13.3 


The robot will rotate in place in the clockwise direction if you were looking down at the robot 
from above (i.e., spin to the right). 


The robot will rotate in place in the counterclockwise direction (i-e., spin to the left). 


The robot will rotate in the counterclockwise direction with the center of rotation at its left 
wheel. 


The robot will rotate in the clockwise direction with the center of rotation at its right wheel. 
The robot will rotate in the clockwise direction with the center of rotation at its left wheel. 


The robot will rotate in the counterclockwise direction with the center of rotation at its right 
wheel. 


The robot will rotate in the counterclockwise direction while also translating forward. 


The robot will rotate in the clockwise direction while also translating forward. 


Chapter 14 


Robo Week 1b: Making a Robot Move 
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14.1 Sense, Think, Act 


One way to think about robots is to loosely break down their behaviors and subsystems into sense, think, and 
act. In the broadest terms, sensing involves acquiring information about the robot’s surroundings, thinking 
means interpreting sensor input and making decisions about what to do next, and acting involves executing 
on those decisions. 

In the robo module we will be working on all of these areas as we learn new conceptual material: 


« Sense: We will use data from the Robot’s LIDAR to identify walls and obstacles. 


« Think: We will use our knowledge of functional covers and the location of obstacles to determine a 
safe path for the robot. 


« Act: We will determine the appropriate wheel velocities needed for out robot to drive a planned path, 
and send the appropriate commands to the motors to achieve our objective. 


14.2 Programming a Robot on a (Miro) Whiteboard 


Today, you will be programming a vehicle to perform the behaviors you saw in the video of the real life 
Braitenberg vehicles (the one with wary, obsessive, etc.). Feel free to re-watch the real-life Braitenberg 
vehicles video. However, instead of programming the robot using a computer, you will be programming it on 
everyone’s favorite piece of software: the Zoom! How can you program using a whiteboard (we imagine you 
conveniently might ask)?!? Remember, we are thinking of our robot’s brain as a sensory-motor mapping. 
Translated into the language of mathematics this simply means that our robot program is specified by a 
function from sensors to motors! 

There are many ways to represent a function. One way is as an equation. For instance, if we use the 
symbol £ to represent the reading of the robot’s light sensor, then a robot that moves faster and faster as it 
see more and more light might have V;,(¢) = ¢? and Vp(¢) = @?. Another way to represent a function is to 
define it graphically. You could draw a function that has @ on the x-axis and Vy, on the y-axis. You could 
then sketch the relationship between those two quantities. Doing this graphically you could either have a 
quantitatively accurate sketch or a sketch that simply characterizes the function’s qualitative behavior. For 
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sensors that have binary values, like the bump sensors, you can exhaustively enumerate all conditions. For 
instance, here is the program of a robot that drives forward at a 0.5% until it rams into something 


0.5“, bumpr =0 

Vi(bumpr) =4° id (14.1) 
Ov, bumpr=1 
0.5%, bumpr =0 

Vr(bumpr) = 4 om ® sa (14.2) 
Ov, bumpr=1 


where bumpr is the value of the forward bump sensor (1 when in contact with something, o otherwise). 


Exercise 14.1 


Work through generating robot programs to realize the behaviors in the video of the real life 
Braitenberg vehicles (obsessive, wary, indecisive, paranoid, insecure). Before jumping in, read the 
questions below and make sure to look at the template on the next page. 


1. In order to validate your proposed program, it helps to do a quick whiteboard simulation. 
Sketch out a few key instants in time, what the robot’s sensors would read, and what the wheel 
velocities would be. After the first couple you may be able to easily see whether or not your 
“program” is correct without actually sketching the key frames. If this seems a little vague, 
check out the template on the next page, which we have made to help scaffold this 
activity. If it is still vague, check out the sample solution for the “wary” behavior. 


. At least one of the behaviors cannot be reproduced without some primitive form of memory 
(although perhaps if you are very creative it can work). Which behaviors are these? How can 
you tell? 
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This template is designed for annotating in Zoom 


Step 1: Label your motors and sensors Step 2: Define your Sensory-Motor Mapping 


Left wheel You could do this graphically using the provided axes, or as a function (as shown in the document) 
(Velocity given by V, ) 


Positive velocity goes towards 
The right of the figure 


A A 
































Right wheel 


elocity given by V, 
(Ve yg y VR) Sensor reading Sensor reading 


Step 3: Sketch some key frames by showing where the robot is in its environment, its sensor readings, and its resultant velocity 


Time 1 




















Time 2 




















Time 3 
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Exercise 14.2 


Next, Imagine your robot can remember a small amount of information. Specifically, your robot has 
access to a single flag that starts out with the value o. Its value can be toggled from o to 1 or from 1 
to o when a particular event occurs. For instance, if the light sensor reads a certain value, the robot 
might toggle its flag. The value of the flag can then inform the behavior of the robot. Given this new 
capability, implement any behaviors in the video that you couldn’t before. 


CO 


If you get done early and you're feeling excited about this, consider adding an additional light sensor 
to your robot. Now that you have two light sensors, you can get the robot to do a richer set of behaviors. 
Sketch the configuration of sensors on your new Braitenberg vehicle (equipped with two light sensors). Try 
to reproduce behaviors such as light seeking and light avoiding. For more ideas see the Wikipedia page on 
Braitenberg vehicles. 





14.3 The Motion of Rigid Bodies 


Our first challenge in Robo Ninja Warrior is going to involve the motion of rigid bodies (a rigid body just 
means an object that doesn’t change shape as it moves around). You’re probably all familiar with the idea 
of the velocity of a body from your previous coursework in physics, but you probably haven’t thought too 
much about the concept of the angular velocity of a rigid body. The angular velocity of rigid bodies will turn 
out to be important for programming our robot to move along precisely defined paths. In this section, you'll 
be starting to get a feel for the concept. 

We are going to explore the concept of angular velocity using an "app" for your phone. Please download 
and install the "phyphox" app to your phone, and open the "Gyroscope sensor.’ 
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Exercise 14.3 


Qualitative: For each of the questions below, you should "plot" the data on the board, and interpret 
the data qualitatively in terms of the coordinate system of the phone. 


1. Place your phone on the table and spin it, in place, counterclockwise. Note that you should be 
spinning it about an axis that is orthogonal to the face of the phone. Which axis is this on the 
data graph? What happens if you spin it clockwise? 


. Now spin the phone about the two other axes. Which axis is which? Which direction is 
clockwise and which is counterclockwise? Clearly draw the coordinate system the phone is 
using - use the unit vectors x, y, and z. 


. What happens if you move the phone along a straight line (on the table) without turning the 
phone? 


. What happens if you move the phone uniformly in a circle without turning the phone? i.e. 
the orientation of the phone does not change. 


. What happens if you move the phone uniformly in a circle while turning the phone at the 
same time? i.e. imagine the phone is a car and you are driving in a circle. 





Now that we’ve explored angular velocity using the phone, let’s make it quantitative. We will use the 
following notation for the angular velocity 


W = We + Wyy + WzZ 


so that w,, is the component of angular velocity corresponding to rotation about the x-axis and so on. The 
units of angular velocity are in radians per second, e.g., rotating in a complete circle in one second would be 
a 27 radian/second rotation. 


Exercise 14.4 


Quantitative: For each of the questions below, you should “plot” the data on the board (please 
interpret these quotes as meaning “sketch” what you think the data would look like, don’t start 
writing MATLAB code), and interpret the data quantitatively in terms of the coordinate system of 
the phone. 


1. Predict the angular velocity if you place the phone down on the table and then spin the phone 
in place so that it spins once in 5 seconds. Confirm your prediction using the data. 


. Predict the angular velocity if you uniformly move the phone in a circle in 5 seconds (while 
turning it as in the last step of the previous problem), and confirm your prediction using the 
data. Does it matter how large the circle is? 


. What type of motion would give rise to a constant w, of 2 radians per second for 5 seconds, 
with both wz = 0 and w, = 0? Confirm your prediction with the phone. 


. What type of motion would give rise to a sinusoidal w, with amplitude of 2 radians per second, 
and a period of 10 seconds, with both w, = 0 and wy = 0. 


. What type of motion would give rise to a constant w, and w, of 2 radians per second for 5 
seconds, with w, = 0. Confirm your prediction with your phone. 
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6. Sketch a graph of your own choosing of wz, wy, and w, and challenge yourself to produce it 
using the phone! 
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Solution 14.1 


1. Here is a potential solution for the wary behavior. You could also do this one similarly to the 
example given above by writing out the functions as in Equations 14.1-14.2, but we wanted to 
show you an example of writing the “program” graphically. 


First, sketch the robot and label the sensors (in this case the light sensor) and its actuators (the 
wheels). Assign notation to relevant quantities. 


Light sensor 
(Measured value given byl, where 
___ Left wheel a high value indicates high 
(Velocity given by V, ) intensity of light) 
Positive velocity goes towards 
The right of the figure 























Right wheel 
(Velocity given by Vp) 


Write down V7, and Vp as functions of the light sensor reading @. 





0.5 m/s —— > 
Vi Ve 





> 
Light Sensor Measurement (¢) 








Ambient light level of the room 


Sketch some keyframes to build confidence in your solution. 
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Region in the shadow 





Time instant 1 


Light sensor 
+ Light sensor is close to the room light level 
+ Left and right wheel velocities will 
be about 0.5 m/s 







V_=0.5 m/s 




















V_=0.5 m/s 














Time instant 2 


+ Light sensor is a little bit less than the room light 
level 

+ Left and right wheel velocities will be 
about 0.25 m/s 

V_=0.25 m/s 


|+——» 








Vp=0.25 m/s 


| ee 


























Time instant 3 


+ Light sensor is a much less than the room light level 
+ Left and right wheel velocities will be 0 m/s 


























2. If you are strict about defining the velocity just based on the sensor readings (and not on 
the current velocities of the wheels), then the obsessive behavior would be impossible to 
implement without some sort of memory. The reason would be that when you are halfway 
between the two shoes the robot wouldn’t know whether to go left or right (since the sensor of 
“no bump detected” would be the same in either case. If you imagine the robot’s motor system 
working a bit differently (e.g., maintaining the current velocity unless otherwise commanded), 
then you could argue that no memory is needed. 


Solution 14.2 


For the obsessive behavior you could do something like. 
Start with flag = 0. 


—0.5™ 


™, bumpp =1 


0.5%, else if bumpr = 1 


V,(b ,b , flag) = : 
(bump r, bumpr, flag) 0.5%, elseif flag =0 (14.3) 
—0.5%, else if flag = 1 
Vr same as Vz, (14.4) 


We would also need to update the flag whenever a bump occurs by changing it from a 1 to ao or 
vice-versa. 
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Solution 14.3 


1. The graph shows a positive angular velocity int the z-direction. When you spin it clockwise, 
the sign of the angular velocity becomes negative. 


2. On my iPhone the positive y-axis runs along the long axis of the phone away from the bottom 
of the phone (where the home button would be on older models). I can tell this since a 
counterclockwise rotation about this axis yields a positive angular velocity in the y-direction. 
Using similar logic, I can tell that my phone’s positive x-axis points to the right, across the 
short edge of the phone screen. You can see this in the iOS documentation using this link: 
https://developer.apple.com/documentation/coremotion/getting_raw_gyroscope_events. 


3. The gyroscope reads values close to o for all axes. 
4. The gyroscope reads values close to o for all axes. 


5. The gyroscope reads a relatively constant value in the z-direction. The magnitude of the value 
corresponds to how long it takes to go around the circle (radius does not matter) and the sign 
tells us which direction we are traveling around the circle. 


Solution 14.4 


1. The angular velocity should be approximately 2" radians/s Z (assuming we spin it counter 
clockwise). 


2. The angular velocity should be approximately 27 radians/s z (assuming we move counter- 
clockwise around the circle). The radius of the circle doesn’t matter. 


3. Any motion that involves rotating the phone purely about z (the screen is aligned to Z) at the 
specified rate. An example would be moving the phone uniformly around a circle a total of 
5sx2 radians/s 
2Qrradians/revolution 
the linear motion can be anything you want). 





= 1.6 revolutions in 5 seconds (other motions will work as well, e.g., 


4. While many motions could achieve this, one possibility is to spin the phone about its z axis, 
starting with slow rotation, gradually ramping up in speed, then down in speed, reversing 
direction, getting faster, slowing down, and ultimately reversing direction. This complete cycle 
should take 10 seconds. 


5. Spinning the phone around an axis pointing out of the phone at an angle of 45 degrees to the 
right (good luck actually doing this!). The phone should rotate once in about 2.25 seconds. 


6. Let’s see what you can come up with! 
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? Learning Objectives 
By the end of this assignment, you should feel confident with the following: Concepts 
- Visualizing parametric curves. 
* Defining vector functions for a given curve. 
+ Computing relevant unit vectors like tangent, normal, and binormal. 
+ Computing the curvature and torsion of a curve. 
+ Computing the length of a curve. 
+ Interpreting motion in terms of these concepts. 
MATLAB skills 
« Alter MATLAB starter code for a unit circle for the general case of a circle or ellipse. 
« Compute the curvature and torsion of a curve using the symbolic math toolbox. 


« Compute the length of a curve using the symbolic math toolbox. 


Overview and Orientation 


In Module 1 we introduced the concept of parametric curves. We are now going to return to this subject, but 
in a more general framework using vectors. 
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This assignment draws from material in multi-variable and vector calculus, and any textbook in these 
subjects will have related material. Keywords include parametric curves, curve length, and line integral. 
Good sources include Paul’s Online Math Notes—the section on Calculus III. The relevant Khan videos are 
also useful. 

Visualizing parametric curves and associated quantities like tangent vectors etc is a critical part of 
developing an understanding of the connection between parametric curves and the motion of moving bodies. 
Linda Vanasupa has created a video about using CalcPlot3D to visualize parametric curves—it is available 
here. 

Although you can evaluate the derivatives and integrals in this assignment by hand, we would also like 
you to use the Symbolic Toolbox in MATLAB for this purpose—we will be using this toolbox throughout 
this robotics module. You will find a starter MATLAB script here that uses symbolic Matlab to work through 
the circle example below. 


15.1 Parametric Curves 


In Module I we considered curves in the plane, represented by either an explicit function, y = f(x) or 
x = f(y), an implicit function f(x,y) = 0, or a set of parametric equations 


z= f(u),y =g(u) 


where we treat u as a parameter. Each value of u defines a point (f(u), g(u)) which we can plot. If we 
collect all the points defined by u € [a,b], then we get a parametric curve. In Module 1, we did not limit 
ourselves to curves in the plane. For example, in 3D we defined 


t= f(u),y = gu), 2 = h(u) 


and the collection of points so defined trace out a curve in 3D. 

An alternative to these coordinate definitions involves representing each point with a position vector, 
r(u). Since the position vector depends on a single parameter u, the end of the position vector traces out a 
curve in space. If we limit ourselves to 3D, we will usually use the following notation 


r(u) = x(u)it y(u)j + z(u)k, u € [a, bj 


where i, j, and k are the standard Cartesian unit vectors. In a sense the vector function r(u) lifts the interval 
(a, b| and transforms it in order to produce a curve in 3D space. 

One major advantage of this notation is that we can take derivatives of this vector function with respect 
to the parameter u 

! d * * 1, 
r(u) = aa (w(wji + y(u)j + 2(u)k) : 
U 
= w(uji+y (uj +2(u)k, 


since the Cartesian unit vectors are constant. We can interpret the derivative as follows: for any given value 
of u this vector is tangent to the parametric curve. At times we might be more interested in a unit tangent 
vector T, which we can obtain by normalizing the derivative 


yr’ 


T=— 
Ir" 
The trace of the tangent vector tip as wu varies, T (uw), also produces a curve; taking its derivative (+), 
produces a vector, tangent to T(u), which we will define as the normal vector to the original curve, r(w). 
The unit normal vector N is therefore 
TT 
— «(|T| 
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Finally, we can use both the unit tangent vector and the unit normal vector to define a unit binormal vector 
B as follows 

B=TxN 
Taken together, these three unit vectors are mutually orthogonal and therefore form an orthonormal basis of 
3D space. This is known as the Frenet-Serret frame, and some applications can be found on the Wikipedia 
page concerning Frenet-Serret Formulas. 


& 


In addition to these unit vectors, parametric curves in 2D and 3D are often described in terms of their 
curvature « and torsion 7. The curvature is the normalized rate of change of the unit tangent vector 





[T"| 
= 

Ir | 
and measures how quickly a curve is changing direction - a large value of the curvature means the curve is 
changing direction rapidly. The curvature is always non-negative. A straight-line would have zero curvature. 

The torsion is the normalized rate of change of the unit binormal vector in the direction opposite to the 
unit normal 

~ B 


en 


and measures the rate at which a curve is twisting out of the plane - a large value of the torsion means 
the curve is rapidly twisting out of the plane. A curve in the plane has zero torsion. The torsion can be 
positive or negative, and convention dictates that a right-handed curve has positive torsion. As Wikipedia 
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says “Intuitively, curvature measures the failure of a curve to be a straight line, while torsion measures the 
failure of a curve to be planar.” 

Aside: You might notice that our definition of torsion looks different from the definition you'll find on 
Wikipedia. That’s because we’re giving you a more general definition; the normalizing factor |r’| is not 
required when you parameterize a curve using arc length (as in the Wiki definition). 

Now that we know how to define a general parametric curve, we are ready to compute with it. For 
example, we could compute the length of the curve. In order to do so, let’s lay down a set of points in the 
u-domain separated by Au. Each point is mapped to the space curve, so the approximate length of each 
section of the curve is, 


AL = |r’ (u)|Au 


Refining this for smaller Au and then summing up the pieces results in the integral 


b= [ida 


which defines the length of the curve. 


15.1.1. The Parametric Circle 


Let’s take a few minutes to digest some of the theory by looking at a very common example—the parametric 
representation for a circle of radius R, centered at the origin in the ry-plane. If we define the position vector 


r(u) = Rceosui+t Rsinuj, u € (0, 27] 


then the circle is traced out once in the counterclockwise direction starting at (R, 0). In this way, we can 
identify the parameter u as being the angle from the x-axis to a point on the circle. 

Let’s compute (by hand) the various unit tangent vectors, the curvature, the torsion, and the length of 
the curve. The first derivative of the position vector is 


r’(u) = —Rsinui+ Reosuj 


The unit tangent vector is 
x ry’ 
Ir" | 
= —sinui+cosuj 
and is tangent to the circle (you could check that r - T = 0). The unit normal vector is 


‘ Si 
N= —— 
|1"| 


= -—cosui-sinuj 
and is normal to the circle, pointing inward (you could check that T - N). The unit binormal vector is 


B = TxN 


(—sinu i+ coswuj) x (—cosui-—sinu fj) 


l| 


= (sin?u+cos?u) k 


= k 


and is out of the plane of the circle. The curvature of the circle is 


= 


‘| 





r’| 


ale 
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and is inversely proportional to the radius of the circle. The torsion of the circle is 
. B’ 

el 

= 0 


is zero because the circle is a plane curve and the binormal vector is a constant. For the length of the curve, 
we have 





Ir/(u)| = +y/(—R)? sin? uw + (R)? cos? uw 


and 


[r'(u)| =R 


and the integral becomes 
20 


L= Rdu = 27rR 
0 


which is the circumference of a circle of radius R as expected! 


Exercise 15.1 


. Define a vector function r(u) in the xy-plane whose trace is a circle centered at (Xo, yo) with 
radius R. 


. Use CalcPlot3D to visualize the circle for different centers and radii, along with the unit 
tangent and normal vectors. 


. Determine (by hand) the unit tangent vector. 
. Determine (by hand) the unit normal vector. 
. Determine (by hand) the unit binormal vector. 


. Determine (by hand) the curvature and torsion. Does the curvature or torsion depend on the 
location of the circle center? 


. Set up the integral to compute the perimeter of the circle, and evaluate it by hand. (Given that 
it’s a circle, what do you expect the length of the curve to be for u=o to 277?) 


Exercise 15.2 


. A helix in 3D can be defined by the vector function 


r(u) =acosuitasinuj+buk,a>0,b>0,u>0 


Use CalcPlot3D to visualize the helix for different centers and radii, along with the unit 
tangent, normal, and binormal vectors. 


. Determine (by hand) the unit tangent vector. 
. Determine (by hand) the unit normal vector. 


. Determine (by hand) the unit binormal vector. 
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5. Determine (by hand) the curvature and torsion. 


6. Set up the integral to compute the length of the helix corresponding to 5 complete turns, and 
evaluate it (by hand). 


The helix is a great example of a curve in 3D, and shows up in all sorts of places. 
Visualizing the unit vectors associated with the curve is more challenging because 
they live in 3D, and we are asking you to define the domain so that the helix 
completes 5 turns. You should also find that the curvature and torsion of the helix 
are constant, and indeed any space curve with constant curvature and torsion is an 
helix. We often define a helix in terms of its radius a, and its pitch 27b, which is 
the height of the helix after one complete turn. 


CO 


15.1.2 Using Symbolic Solvers 





As the parametric functions that define our curves get more complicated, finding the various vectors and 
properties of the curve by hand can become tedious. Instead, we will rely on symbolic solvers to perform the 
calculations. In QEA we will primarily use the Symbolic Toolbox in Matlab for these operations. 


Exercise 15.3 


Download the Matlab script here that walks through solving the parametric circle example using 
Matlab’s Symbolic Toolbox. Note: You can save these files as Matlab Live Scripts (.mlx) which can 
make the symbolic output easier to read. 


1. Review the syntax used in the script for creating symbols, symbolic functions, and performing 
symbolic operations. 


2. Modify the script for the circle located at (15, yo). 


Exercise 15.4 


Define a vector function r(u) in the xy-plane whose trace is an ellipse centered at (Xo, yo) with 
semi-major axis a, and semi-minor axis b, b < a. 


. Use CalcePlot3D to visualize the ellipse for different centers and semi-major axes, along with 
the unit tangent, normal, and binormal vectors. 


. Determine the unit tangent vector using the Symbolic Toolbox in MATLAB. 
. Determine the unit normal vector using the Symbolic Toolbox in MATLAB. 
. Determine the unit binormal vector using the Symbolic Toolbox in MATLAB.. 
. Determine the curvature and torsion using the Symbolic Toolbox in MATLAB. 


. Set up the integral to compute the perimeter of the ellipse using the Symbolic Toolbox in 
MATLAB, and numerically evaluate it for a specific case of (Xo, yo), a, b. 
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You will find that the integral for the perimeter of the ellipse involves elliptic integrals 
which cannot be evaluated using elementary functions. Check out this page at the 


American Mathematical Society for an interesting review. 


CO 


15.2 Motion of Bodies 





So far we’ve been talking about the intrinsic geometry of curves. However, there is an intimate connection 
between the geometry of curves and the motion of bodies. Assume a body is moving in space and is described 
by a position vector r(t) defined in terms of a fixed frame. In component form we write 


r(t) = x(t)it+ yj + 2(t)k 


where ¢ is time. The units of r(t) are length. 
The derivative with respect to time of this position vector defines the velocity of the body 


v(t) =r'(t) = a'(tH)i+ y' (Oj + 2'Ok 
and the second derivative with respect to time of this position vector defines the acceleration of this body 
a(t) =r"(t) = 2"(Hi+y" (Oj +2" (Ok 


It will be instructive now to ask how the velocity vector and acceleration vector are oriented with respect 
to the path of the body as it moves through space. If we treat t as a parameter, and view the motion of the 
body as a parametric curve, then we can use the machinery of parametric curves to answer this question. 

Let’s start with the velocity vector. We know from our earlier work that the derivative r’(t) is tangent to 
the curve, which implies that the velocity must be tangent to the curve. Recall that earlier we defined the 


unit tangent to be 
/ 
~ t 
T(t) — = ) 
[r’(é)| 


Re-arranging this definition we can express the velocity in terms of the unit tangent vector ah 





v(t) = v(t) T(t) 


where v(t) = |r’(t)| is the linear speed of the body in the tangent direction, and we explicitly note that T(t) 
is a function of t, ie. the unit tangent direction changes as we move along the curve. 
What about the acceleration a(t)? If we take the derivative of the velocity we see that 


a, = : (oi) 


because both the magnitude and direction of velocity can change in time, and we need to use the product 
rule for derivatives. Recall from earlier that the rate of change of the unit tangent vector is related to the 
unit normal vector : 

dT ya 
— =|T'|N 
Te a 


and the magnitude of the rate of change of the unit tangent vector is related to the curvature 


[T!| = ale" 
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Since |r’| = v we have 


T : 
oe = Kol 


so that the acceleration becomes 
a(t) = oe + Ku2N 

Let’s pause for a moment to consider this. We have expressed the acceleration of a moving body in terms of 
the unit tangent vector and the unit normal vector, so we will often talk about the tangential acceleration 
and normal acceleration of a body. You might recall that because velocity is a vector, it can accelerate by 
changing in magnitude ("speed") or changing in direction. The magnitude of the tangential acceleration is 
just the rate of change of the linear speed. On the other hand, the magnitude of the normal acceleration 
is caused by the constant change in the direction of the velocity vector as it moves around the circle. This 


normal acceleration is proportional to the square of the linear speed and the curvature of the path along 
which the body is moving and is directed normal to the curve. 


15.2.1 The Circle Example 


Consider the example of a body moving in a circle of radius R at some constant linear speed v. What is the 
position vector for such a body? Well, we know that it should look like a parametric circle, so let’s define 


x = Rcos(wt) 
= Rsin(wt) 


where w is a variable that we need to define. In vector notation we have 
r(t) = Reos(wt)i + Rsin(wt)j 


Using the approach from the previous section we can compute the unit tangent vector and unit normal 
vector to this curve, 


T = —sin(wt)i + cos(wt) 
N = —cos(wt)i — sin(wt)j 


The velocity vector is 
v(t) = —Rwsin(wt)i + Rw cos(wt)j 


which we expect to be tangential to the curve. One way to check is to find the tangential and normal 
components of velocity by evaluating v -'T and v - N. We obtain 


v-T= Rw 


v-N=0 


which means that the velocity can be expressed as 
v(t) = RwT 


We should now recognize w as the angular velocity of the body as it moves in uniform circular motion. The 
circular motion is uniform because it moves a constant number of radians per second. The acceleration 
vector is 

a(t) = —Rw”? cos(wt)i — Rw? sin(wt)j 


Since the linear speed of motion is constant (v = Rw) we would expect the acceleration to be in the normal 
direction only. Again we can compute the tangential and normal components of acceleration by evaluating 
a-Tanda-N. We obtain 

a-T=0 


a-N= Ru” 
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which means that the acceleration can be expressed as 
a(t) = Rw?N 


A body in uniform circular motion has no tangential component of acceleration - it is purely normal. Using 
the earlier expression for the angular velocity we could just as easily write the normal component of the 


acceleration as 
a 


ae aa} 


which hopefully agrees with some results you saw a long time ago in school. It also connects to our earlier 
expression since the normal component of acceleration should be Kv”, and k = z for a circle. 


Exercise 15.5 


Consider a body undergoing non-uniform circular motion with radius F so that it’s angular velocity 
is linearly increasing with time, w = at, ie. the body starts off at rest and speeds up. Assume 
position is measured in meters and time is measured in seconds. 


1. Define a position vector for this moving body. How long should it take the body to make its 
first loop? How about its second loop? 


. Visualize the motion in CalcPlot3D. 


. Determine (by hand) the velocity of this moving body. How does the linear speed depend on 
Rand a? 


. Determine (by hand) the acceleration of this moving body, and decompose the acceleration 
into the unit tangent and unit normal directions. Explain the result. 


You've probably seen and thought about uniform circular motion before. Often it is 
easier to understand a concept by looking at one just a little more complicated, so here 
we ask you to consider non-uniform circular motion. Although the path is the same 
curve, the motion is different. 


Exercise 15.6 


. Consider a body moving in 3D with position vector 


r(t) = acos(ct)i + asin(ct)j + bctk 


Assume that the position is measured in meters and time is measured in seconds. Describe the 
path that the body should take. Interpret the variables a, b, and c. 


. Visualize the motion in CalcPlot3D. 


. Determine (by hand) the velocity of this moving body. How does the linear speed depend on 
a, b, and c? 


. Determine (by hand) the acceleration of this moving body, and decompose the acceleration 
into the unit tangent and unit normal directions. 


Here we have a body moving in 3D on a curve that we have seen before. Pay 
attention to the direction of the unit tangent and unit normal as the body moves 
along this curve. 
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Exercise 15.7 


Consider a body moving with the following position vector 
r(t) = acos(ct)i + bsin(ct)j 
where a > 0, b > 0, and c > 0. Assume that position is measured in meters and time in seconds. 
. Describe the path that the body takes. How long does it take to return to its starting position? 
. Visualize the motion in CalcPlot3D. 


. Use the Symbolic Toolbox in MATLAB to determine the velocity of this moving body. How 
does the linear speed depend on a, b, and c? 


. Use the Symbolic Toolbox in MATLAB to determine the acceleration of this moving body, and 
decompose the acceleration into the unit tangent and unit normal directions. 


Here we have a body moving on a path that corresponds to a curve that we studied 
earlier, and so in many ways this is nothing new. However, the motion of a body consists 
of both the path and "how" it moves along it. Interpreting the velocity and acceleration 
in terms of the variables a, b, and c will help you build your understanding of these 
concepts. 


CO 


15.3 Simulator Setup 





We will begin using the Robo simulator during week 2, and we want to make sure that everyone has it 
working. 


Exercise 15.8 


. Work through the simulator setup steps on the Meeto Your Neato page. 


. Make sure the simulator is operating correctly by running the “teleopAndVisualizer” script 
and driving the robot using your keyboard. 


. Take a screenshot of the MATLAB figure (LIDAR output), and include it with your homework 
submission. 
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Solution 15.1 


1. Define a vector function r(u) in the xy-plane whose trace is a circle centered at (%o, yo) with 
radius R. The equation for a circle centered at (9, yo) with radius R is: 


r(u) = (xo + Reosu)i + (yo + Rsinu)j 


2. Use CalcPlot3D to visualize the circle for different centers and radii, along with the unit 
tangent and normal vectors. In CalcPlot3D you can use the “Space Curve: r(t)” option under 
the “Add to graph” menu with the settings shown below as an example. 


= Welcome to CalcPlot3D! 


aeaeaeeee) 


{Graph |[ 3D Mode eal ¢ 
(Aad wert | A 
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Trace: t =|6.283185307 174 fo} 


[Animate | 
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3. Determine (by hand) the unit tangent vector. 





r(u) = (xo + Reosu)it (yo + Rsinu) j 
r(u) = —Rsinui+ Rcosuj 
|r| = V R2 sin? u + R2 cos2u = R 
A ry’ 
| ea — 
[r’| 
T = —sinui+cosuj 


4. Determine (by hand) the unit normal vector. 





ea 
|T"| 
T = —sinui+cosuj 
T’ = -cosui-sinuj 
IT’) = W(—cosu)? + (—sinu)? =1 
N = —cosui-—sinuj 


5. Determine (by hand) the unit binormal vector. 


A 


B = TxN 

= (-sinui+cosuj) x (—cosui-—sinuj) 
= (sin? u+ cos? u) k 

= k 
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6. Determine (by hand) the curvature and torsion. Does the curvature or torsion depend on the 
location of the circle center? Curvature: 


|" 

[r’| 
IT’) = W(—cosu)? + (—sinu)? =1 
Ir’| = VR2sin?u+ R2cos2u=R 











Torsion: 


= <M. 
r [r’| 


0 
oe ee, 
= (—cosui-—sinu fj) R 





No, we don’t see X or yo in the equations for curvature or torsion. 


7. Set up the integral to compute the perimeter of the circle, and evaluate it by hand. (Given that 
it’s a circle, what do you expect the length of the curve to be for w=o to 27?) 





b 20 
i= | lr’(u)| du = V R2 sin? u + R2 cos? u du = 20R 
a 0 


Solution 15.2 


Solution 15.3 


1. Review the syntax used in the script for creating symbols, symbolic functions, and performing 
symbolic operations. 


2. Modify the script for the circle located at (1% , yo). An example modified script is here: link. 


Solution 15.4 
Define a vector function r(u) in the xy-plane whose trace is an ellipse centered at (Xo, yo) with 
semi-major axis a, and semi-minor axis b, b < a. 
A Matlab solution script can be found here: link. 


1. Use CalcePlot3D to visualize the ellipse for different centers and semi-major axes, along with 
the unit tangent, normal, and binormal vectors. 
The equation for an ellipse centered at (2, yo) with semi-major axis a, and semi-minor axis b, 
b < ais: . 
r(u) = (%p + acosu) i+ (yo + bsinu) j+0k 
In CalcPlot3D you can use the “Space Curve: r(t)” option under the “Add to graph” menu 
with the settings shown below as an example. 
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2. Determine the unit tangent vector using the Symbolic Toolbox in MATLAB. 


a —asinui bcosuj ok 
/a?| sin ul? + b2| cosul? —-\/a?| sin ul? + 62] cos ul? 








3. Determine the unit normal vector using the Symbolic Toolbox in MATLAB. 


N —bcosui asinuj ~ 
= T 
Ja? sinu2 — 6 sinu2 +62 Va? sinu2 — b2 sinu2 + b? 








4. Determine the unit binormal vector using the Symbolic Toolbox in MATLAB. 


B = 0i+0j+1k 


5. Determine the curvature and torsion using the Symbolic Toolbox in MATLAB. 
Curvature: 


ab 
(a? sin u2 — b? sin u2 + b?)3/2 





Torsion: 


6. Set up the integral to compute the perimeter of the ellipse using the Symbolic Toolbox in 
MATLAB, and numerically evaluate it for a specific case of (9, yo), a, b. 


You will find that the integral for the perimeter of the ellipse involves elliptic integrals 
which cannot be evaluated using elementary functions. Check out this page at the 
American Mathematical Society for an interesting review. 
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Let %5=0, y5=0, 0=1, and D=2. 


2n 
i= | |r’(u)| du = 9.69 
0 


Solution 15.5 


Consider a body undergoing non-uniform circular motion with radius FR so that it’s angular velocity 
is linearly increasing with time, w = 2at, i.e. the body starts off at rest and speeds up. Assume 
position is measured in meters and time is measured in seconds. 


1. Define a position vector for this moving body. How long should it take the body to make its 
first loop? How about its second loop? 


r(t) = Rcos(at”) i+ Rsin(at?)j+0k 


We know the body will have completed one loop when at? = 27. Therefore, ty) = ,/ on 


Similarly, time to complete two loops is at? = 47 and tz = 4/ iz The time to complete just 


the second loop is t2 — t; = (2— V2),/7/a. We expect the second loop to take less time than 
loop one. 


2. Visualize the motion in CalcPlot3D. 


3. Determine (by hand) the velocity of this moving body. How does the linear speed depend on 
Rand a? 





v(t) = r(t) 

v(t) = —2Rtasin(at?) i+2Rtacos(at?) j + 0k 
Find linear speed: 

v(t) = /(—2Rtasin(at?))? + (2Rtacos(at?))? 

v(t) = 2Rta 


Linear speed increases with time ¢ and is proportional to R and a. 


4. Determine (by hand) the acceleration of this moving body, and decompose the acceleration 
into the unit tangent and unit normal directions. Explain the result. 


You’ve probably seen and thought about uniform circular motion before. Often it is 
easier to understand a concept by looking at one just a little more complicated, so here 
we ask you to consider non-uniform circular motion. Although the path is the same 
curve, the motion is different. 
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v(t) 
—2Rta sin(at”) i+ 2Rtacos(at”) j +0k 
—2Ra(sin(at) + 2at? cos(at?)) i+ 2Ra(cos(at?) — 2at? sin(at?)) j +0k 


r’(¢) 
Ir’(t)| 
— sin(at?) i + cos(at?) j +0k 





Hp 


rv) 
|T’(é)| 
— cos(at?) i— sin(at”) j +0k 





a(t)- T(t) = 2Ra 
a(t) - N(t) = 4Rt?0? 


The tangential component of the acceleration is constant in time, but the normal component increases 
quadratically with time. Compare this to the case of circular motion at a constant speed which has 
zero tangential acceleration and constant normal acceleration. 


Solution 15.6 


Solution 15.7 


Consider a body moving with the following position vector 


r(t) = acos(ct)i + bsin(ct)j 


where a > 0, b > 0, and c > 0. Assume that position is measured in meters and time in seconds. 
A solution script is here: link. 


1. Describe the path that the body takes. How long does it take to return to its starting position? 


We know that this is an elliptical path with semi-major axis a and semi-minor axis b. We know 
that a complete orbit of the ellipse occurs when the parameter ct = 27, so the time it takes to 
return to the starting position is t = (27) /c. 


2. Visualize the motion in CalcPlot3D. 


Setting for an ellipse in CalcPlot3D are above. 


3. Use the Symbolic Toolbox in MATLAB to determine the velocity of this moving body. How 
does the linear speed depend on a, b, and c? 


v(t) = c(—asin(ct) i+ bcos(ct) j) 








u(t) = cy/a? cos(ct)? + b? cos(ct)? 


4. Use the Symbolic Toolbox in MATLAB to determine the acceleration of this moving body, and 
decompose the acceleration into the unit tangent and unit normal directions. 
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Here we have a body moving on a path that corresponds to a curve that we studied 
earlier, and so in many ways this is nothing new. However, the motion of a body consists 
of both the path and "how" it moves along it. Interpreting the velocity and acceleration 
in terms of the variables a, b, and c will help you build your understanding of these 
concepts. 


a(t) = —c?(acos(ct) i+ bsin(ct) j) 


" abc? 


le sin? (ct) + b? cos? (ct) 
A c?(a? — b?) sin(2ct) 
fo? sin? (ct) + b? cos? (ct) 

















Notice that the acceleration vector is in the opposite direction to r, ie. it points toward the origin. 


It is however scaled by a factor of c?. Also notice that if the motion is circular (a = b) then the 
tangential acceleration is zero. 
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Chapter 16 


Robo Week 2a: Curves and Motion 


Schedule 


16.1 The NEATO Goes for a Drive on Parametric Avenue .............+00005 151 








? Learning Objectives 
Concepts 
- From r(¢) data for a rigid body, 
— estimate average speed and distance traveled. 
— approximate T, N, and B at various points on the space curve. 
+ From an r(t) parametric vector function for a rigid body, 
— approximate its space curve (i.e., path of travel) 
— compute the vector functions for r’(t) and r” (t) 
— Compute TF N, and w 
Matlab Skills 


« Compute the angular velocity vector and its amplitude using the symbolic toolbox 


16.1 The NEATO Goes for a Drive on Parametric Avenue 


Here we will work to connect the work you did in week 1 to the upcoming challenge. 

A hypothetical NEATO has just gone for a drive, and we have recorded its position vector r(t). Its path 
is shown below, and the dots indicate its position at equally-spaced points in time. (You can download a 
printable version of this image here). It starts in the bottom left corner and moves along the path until it 
reaches the last point. Let’s assume that this is a relatively long drive - the grid spacing is 1m and the time 


between samples is 1s. 


Exercise 16.1 


CHAPTER 16. ROBO WEEK 2A: CURVES AND MOTION 155 











A 











1 | IAD 






































1. Roughly how long does the NEATO travel for? Roughly how far does it travel? Roughly what 
is its average speed? 


2. Thinking about the curve only, draw the unit tangent vector T and unit normal vector N at 
each of the points indicated: A, B, C, D and E. 


3. Thinking about the motion of the NEATO now, choose one of the points (A,B,C,D or E) and 
compute the magnitude of the velocity vector. Draw the velocity vector to scale at that point. 
Do the same for the acceleration vector, decomposing it into tangential and normal components. 
How do these relate to the unit tangent and unit normal vectors? (Do more points if you have 
time!) 


4. Draw a picture of the NEATO at A, B, C, D, and E, ie. you are looking down on the NEATO as 
it drives along the curve. 


5. The NEATO has its own internally defined coordinate system which is fixed to the robot (this 
is called a body-fixed’ coordinate system). This coordinate system is used, among other things, 
for the readouts from the LIDAR scanner. The NEATO’s coordinate system has the x-axis 
pointing forward, the y-axis pointing left, and the z-axis pointing up. For each of your NEATO 
pictures on the curve, indicate the orientation of the NEATO’s own coordinate system. How 
does this relate to the T and N vectors? 


6. In order for the NEATO to follow the curve, what must be true about the orientation of the 
NEATO’s x-axis as it traverses the curve? What about its y-axis? 


7. The NEATO is an example of a ’rigid body’: an object which has a size (unlike a point particle, 
which you often consider in introductory physics) but for which the different parts of the body 
do not move with respect to one another (no stretching, bending, etc). When we study the 
motion of a rigid body, we can think about decomposing the motion into two components: the 
motion OF the center of the object and the motion ABOUT the center of the object. In other 
words, when we talk about the motion of the NEATO, in order to give a complete description, 
we need to specify the velocity of the center of the robot in the lab x direction, the velocity of 
the center of the robot in the lab y direction, and the rotational motion of the NEATO around 
its center relative to the x axis (0 = 0 when the NEATO is going forward). This system has 
three degrees of freedom: x,y, and @ and we have to give the velocity for each! 
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(a) On your picture, indicate the orientation @ of the NEATO at each of the indicated points. 
Define +0 as the angle of the forward direction of the NEATO (NEATO’s x axis) measured 
counter-clockwise from the lab x direction. 


(b) The angular velocity w is a vector quantity, with magnitude 


ale dé 
dt 


and its direction is the axis of rotation. For an object constrained to move in the xy plane, 
we can express the angular velocity as 


w= wk 


where w, = d0/dt is the rate of change of angle of orientation. What direction is the 
vector, w, if the NEATO is curving to the right? What direction is the vector, w, if the 
NEATO is curving to the left? (Recall: the angular velocity follows the right hand rule.) 
What characteristic vector of your parametric curve is also along this direction? 


If the object is constrained to always be oriented along its path (a NEATO that isn’t 
slipping for example), then a consistent mathematical definition of angular velocity w is 


5 Ae 
— aL es 
Ww x dt 


Note: you'll see a derivation of this relationship in the night assignment, but for 
now let’s just use it as a given. With this definition in mind, give a rough indication 
of the angular velocity vector of the NEATO at points A,B,C,D and E. 


Exercise 16.2 
Consider a NEATO that moves according to the following position vector 
r(t) = 0.05ti + 0.05¢77 
where r(t) has units of meters and t has units of seconds. 


. On the board, sketch the path that the NEATO moves along in 10 seconds, roughly indicating 
its location every second. 


. Approximate and sketch T and N at 1, 2, 5 and 10 seconds on your curve. 


. Compute by hand a vector function for T as a function of time. 


. The direction of N is defined by a Compute oo. (you can leave it as an un-simplified 
equation). 


. Use CalcPlot3D to visualize unit vectors (T, N and B) for the 10 second period. How does 
each change during the period? 


. Derive the vector functions that represent the linear velocity and acceleration as the NEATO 
moves along the path. 


. Pull up the MATLAB symbolic starter code. Discuss how you would alter it to determine the 
angular velocity and visualize T, N and B as the NEATO travels the path. 
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Solution 16.1 


1. Roughly how long does the NEATO travel for? Roughly how far does it travel? Roughly what 
is its average speed? By counting up the points and using 1 second between points, it traveled 
for 33 seconds. To determine the distance traveled, there are lots of ways to estimate these 
values. I turned the path into a series of triangles and computed the approximate length. 


33 See 





].% 


From this, I got 23.2 m. The average speed from these values is 0.70m/s. The overline indicates 
that the "o" is significant. I used 2 significant figures since I only had 2 in the estimation of the 
triangles. 


2. Thinking about the curve only, draw the unit tangent vector T and unit normal vector Nat 
each of the points indicated: A, B, C, D and E. See the image below. T and N are in pencil. 


3. Thinking about the motion of the NEATO now, choose one of the points (A,B,C,D or E) and 
compute the magnitude of the velocity vector. Draw the velocity vector to scale at that point. 
Do the same for the acceleration vector, decomposing it into tangential and normal components. 
How do these relate to the unit tangent and unit normal vectors? (Do more points if you have 
time!) Point A: I’m going to use the points on the curve to estimate the AL over the 2 second 
interval in the point before and after A. Assuming that the grid is "to scale," I estimate the 
speed at A to be, 


_AL 0. 7 
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4. Draw a picture of the NEATO at A, B, C, D, and E, i.e. you are looking down on the NEATO as 
it drives along the curve. 


5. The NEATO has its own internally defined coordinate system which is fixed to the robot (this 
is called a body-fixed’ coordinate system). This coordinate system is used, among other things, 
for the readouts from the LIDAR scanner. The NEATO’s coordinate system has the x-axis 
pointing forward, the y-axis pointing left, and the z-axis pointing up. For each of your NEATO 
pictures on the curve, indicate the orientation of the NEATO’s own coordinate system. How 
does this relate to the T and N vectors? T is co-incident with x-axis of the NEATO. N is 
parallel to y-axis of the NEATO. 


















Ae ‘ 
Peels |_| re 


6. In order for the NEATO to follow the curve, what must be true about the orientation of the 
NEATO’s x-axis as it traverses the curve? What about its y-axis? The NEATO x-axis must be 
co-incident with T. The NEATO y-axis has to be parallel or anti-parallel to N. 














(oo xX 


7. The NEATO is an example of a ’rigid body’: an object which has a size (unlike a point particle, 
which you often consider in introductory physics) but for which the different parts of the body 
do not move with respect to one another (no stretching, bending, etc). When we study the 
motion of a rigid body, we can think about decomposing the motion into two components: the 
motion OF the center of the object and the motion ABOUT the center of the object. In other 
words, when we talk about the motion of the NEATO, in order to give a complete description, 
we need to specify the velocity of the center of the robot in the lab x direction, the velocity of 
the center of the robot in the lab y direction, and the rotational motion of the NEATO around 
its center relative to the x axis (=o when the NEATO is going forward). This system has three 
degrees of freedom: x,y, and @ and we have to give the velocity for each! 


(a) On your picture, indicate the orientation 0 of the NEATO at each of the indicated points. 
Define +0 as the angle of the forward direction of the NEATO (NEATO’s «x axis) measured 
counter-clockwise from the lab x direction. See image above. @ is shown for the point C, 
measured relative to the x-axis of the lab. 


(b) The angular velocity w is a vector quantity, 
ica dé 
w| = — 
dt 
and its direction is the axis of rotation. For an object constrained to move in the xy plane, 


we can express the angular velocity as 


w = wk 
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where w = d0/dt is the rate of change of angle of orientation. What direction is the 
vector, w, if the NEATO is curving to the right? What direction is the vector, w, if the 
NEATO is curving to the left? (Recall: the angular velocity follows the right hand rule.) 
What places Nees of your parametric curve is also along this ode aes When 
curving to the left, 4 ue ; > Oand w points in +k. When curving to the right, 22 < 0 andw 
points in -k. Our B is along this same direction. 


- 


If the object is constrained to always be oriented along its path (a NEATO that isn’t 
slipping for example), then a consistent mathematical definition of angular velocity w is 


. aT 
—_ T — 
Ww x dt 


Note that w is a vector obeys the right-hand rule. With this definition in mind, which 
general direction does w point for the NEATO at points A,B,C,D and E? (This definition 
will be explored more in the overnight). For all points, T is co-incident with the +-axis 


of the NEATO. To figure out the direction of w, we need to consider vt for each point. 
Conceptually, the vector 4 T represents the change in the genes of T with time (the 
magnitude of Tisa aia of y We could attempt to assess < = at each of the points, 


but we can also remember that 4 © will be in the same pate as N, as 


. 7 
N=— 
|T"| 


So we can use our drawings of Nasa proxy for ~ at points A, B, C, D and E. From the 
image above, we will get the following result, — the right-hand rule for w at these 
points: A: —k; B: Hard to tell, just past the inflection point, so guessing —k; C: —k; D: 
+k; E: —k. Notice these results are consistent with the results above- turning left gives 
+k, turning right gives =k 





Solution 16.2 


1. On the board, sketch the path that the NEATO moves along in 10 seconds, roughly indicating 
its location every second. For one second increments, a sketch might look like this: 
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3. Compute by hand a function that represents T as a function of time. T= 


r(t)= © (0.0548 + 0.057) 


= 0.053 + 0.10¢j 


Ir’ (t)| = /0.052 + (0.108)2 
= 0.05 1 + 44? 


and 


so 








r’(t) 


> SO 


r/(t)| 
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4. The direction of N is defined by an. Compute ae (you can leave it as an un-simplified 
equation). 
dT 
dt 
gE _<¢ 1 
dt = dtV/1+ 4t? 
We would need to use the chain rule: 
1 d d 1 
= ——— _— (i+ 24) + (i+ ej 
V1+ 4¢? dt D+ Dt t+ 
_ 1 
~ V1+4e 


=|T’\N 





(i + 2tj) 





(25) + G+ 24)(S)C + 4) 8(84) 


To evaluate le F 


the messy chain-rule derivative. (MATLAB to the rescue!) Computing N involves computing 


PT. 





5. Use CalcPlot3D to visualize unit vectors (‘T, N and B) for the 10 second period. How does 
each change during the period? We can see in this short video that zh begins aligned with the 
x-axis and turns toward the y-axis as t increases; N begins aligned with the y-axis at t=o and 
turns toward -2 as t increases; B does not change-it remains in the k direction throughout 
the time of travel. 


6. Derive the vector functions that represent the linear velocity and acceleration as the NEATO 
moves along the path. From above, 


fij= © (0.0548 + 0.05¢7j) 


= 0.051 + 0.10¢j 
and 


d 
r”(t) = 5 (0.05% + 0.104) 
= 0.10j 


7. Pull up the MATLAB symbolic starter code. Discuss how you would alter it to determine the 
angular velocity, w, and visualize T, N and Bas the NEATO travels the path? From the starter 
code, we would need to change the parametric equations, change the ¢ range ("u" in the code), 
expand the plotting range, and add the equations to compute w, using the equation, 


dT 


=—T — 
lata” 


An example of a MATLAB line of code that would compute this is 


”Compute the angular velocity vector 
omega=simplify(cross(T_hat,dT_hat) ) 


Here is an example of altered MATLAB script that would work. 
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17.1.1 Validating your Model 





? Learning Objectives 


Matlab Skills 
¢ Direct the NEATO to drive forward 


+ Use NEATO position information to verify a motion model. 


17.1 Differential Drive in Action [70 minutes | 


In the first overnight you learned how to determine the velocity and acceleration of a particle moving along 
a parametric curve. Earlier this week, you connected these quantities to the motion of the Neato moving 
along the curve. Next, you'll extend this by considering not just the overall linear and rotational motion of 
the Neato as it moves along the curve, but how the motion of the Neato’s wheels must be set in order to 
achieve this overall motion. To accomplish this you'll be working through the basic mechanics of differential 
drive vehicles. Specifically, you’ll need to understand how the movement of each of the Neato’s wheels 
translates into movement of the robot itself. In this section you will be solving two important, and closely 
related, problems related to robot motion: 


a. Given a desired forward and angular velocity, determine the appropriate velocities of each of the 
robot’s wheels. 


b. Given the robot’s current position, heading, and the velocities of its wheels, determine the robot’s 
new position and heading. Note: solving this problem can be quite useful when you have a sensor that 
estimates the actual wheel velocities of your robot (as the Neato does). In this way you can correct for 
discrepancies between the intended motion and what your robot actually did. 
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Top down view (wheels are exposed for the diagram) 


VL Front of the Robot VR 





Wheel base (d) 





Figure 17.1: A diagram of the Neato’s differential drive system. 


Formalizing the Problem The Neato has two wheels equally spaced about its centerline (see Figure 17.1). 
As we saw during week 1, driving the wheels at different velocities (labeled V;, and Vp in the diagram) will 
achieve different linear and angular velocities. 


Exercise 17.1 


In week 1 of this module you built up an intuition for how movement of each of the wheels for a 
differential drive vehicle would translate into motions of the robot. Before we dive into a quantitative 
treatment of the subject, let’s remind ourselves of some limiting cases. Determine qualitatively how 
the Neato would move (in terms of both linear and rotational motion) in these cases. 


What if both wheels move forward (positive velocity) with equal speed? 
What if both wheels move backward (negative velocity) with equal speed? 
What if one wheel drives forward and the other moves backward with equal speed? 


What if one wheel drives forward while the other remains stationary? 





Now that you have refreshed your intuition, let’s solve the problem quantitatively. The key insight is that 
the robot cannot move laterally, but instead must have a linear velocity parallel to the direction of its wheels. 
As the robot moves along a curve, the robot rotates about its center in order to keep itself aligned with the 
forward motion. Let’s assume that the center of rotation of the robot is located midway between the wheels. 


Exercise 17.2 


Assuming no wheel slippage, the linear speed in the Neato’s direction of motion V and angular 
velocity w can be expressed in terms of the left and right wheel velocities V;, and Vp, and the robot’s 
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wheel base d (the distance between the two wheels). 


_ Vi+ Ve 


V 
2 


(17.1) 


Vr — V; 
w= a (17.2) 


In the equation above, w is a scalar value that can be positive or negative. Do these expressions 
make sense? Can you confirm these expressions? Can you think of some test cases to validate these 
expressions? (hint: you just thought about some in the previous exercise!) 

Note: we are giving you these equations rather than deriving them. If you want to explore 
how to derive theses equation for yourself, you can consult section 1 of this document. 


Exercise 17.3 


Solve Equations 17.1 and 17.2 from the the previous exercise in order to express the left and right 
wheel velocities in terms of the linear and angular velocities and wheel base and show that 


d 
Vy=V-w5 (17.3) 


d 
VR= (ater (17.4) 


Does this make sense? How can you use some of your test cases to validate these expressions? 


eee) 


17.1.1 Validating your Model 





The Equations 17.1 and 17.2 define a motion model for your robot in the sense that they allow us to figure 
out what the resultant linear and angular motion of the robot would be for a given left and right wheel 
velocity. Similarly, we could use Equations 17.3 and 17.4 to figure out what the left and right wheel velocities 
of our robot should be in order to achieve a particular linear and angular motion. This computation can be 
extremely useful because we often have a goal of making our robot move in a particular fashion and the left 
and right wheel velocities are just a means to achieving that goal. 

Let’s further suppose that someone has measured the wheel base parameter d and obtained an estimate 
of 0.2m. If we look at Equations 17.1 and 17.2 we see that now that we have an estimate of d we can plug 
in the wheel velocities V;, and Vp and compute the linear and angular motion of the robot This all sounds 
great, but of course as with any model (this is after all a motion model of the robot), you shouldn’t expect it 
to be perfect. What we'd like to do is run an experiment to see if our model’s predictions actually match 
what happens in real life (or simulated life in our current mode of operation). 


Exercise 17.4 


Design an experiment to determine how well the motion model in Equations 17.1 and 17.2 matches 
the robot’s actual behavior. To further clarify what we mean, here are some things to keep in mind. 
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+ Assume that you can set the left and right wheel velocities to any values you'd like between 
-3m/s and 3m/s (each wheel could be set to a different velocity). 


» If you'd like you can vary the left and right wheel velocities over time. 
+ Assume that you can measure the robot’s position as a function of time. 


For example, you might decide that for your experiment you are going to set Vz and Vp to 0.5m/s 
for 5 seconds and then stop your robot. The results of this experiment might look like this. 


1 
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Note that in this case the robot started in the upper right corner and moved to the lower left (as you 
can see from the right plots). You should notice that if you take the distance between the two end 
points in the left figure you get approximately 2.5m (which makes sense given you went at 0.5m/s 
for 5 seconds). In this case we are able to easily plot the position of the robot since we are using a 
simulator. For a real robot, it would be a more challenging (although doable with some additional 
instrumentation of your robot or its environment). 


. Design an experiment you would carry out to validate the motion model in equations 17.1 and 
17.2. Describe in some detail what your experiment would entail. 


. Sketch some potential results of the experiment if the motion model proves to be relatively 
accurate. 


. What if it turns out that the motor on the left wheel is underpowered and moves at only 80% 
of the velocity you command it to. Qualitatively, how might your results look in this case? 


. Suppose you were to run your experiment and obtain some results, how might you use this 
experimental data to quantify the accuracy of the motion model in equations 17.1 and 17.2? 
Focus on high-level strategy rather than necessarily coming up with an equation. 


. Do the results of your proposed experiment tell you everything you need to know about your 
motion model? If not, what other experiments might you carry out and what information 
would you hope to gain from running them? 


Exercise 17.5 


In this problem we’re going to run through a very basic experiment to test the validity of the motion 
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model. In this experiment we're going to set V, = 0.2m/s and Vr = 0.1m/s and let the robot go 
for 20 seconds. For those 20 seconds we'll be measuring the x and y position of our robot. Once 20 
seconds have elapsed, we’re going to stop the robot. 


1. Assuming the motion model is relatively accurate, sketch some potential results for the 
experiment. If you get stuck, check the solution given for the previous problem. 


. Suppose you run the experiment and collect this experimental data (graph 1 is the y position 
versus the x position of the center of the Neato, graph 2 has x-position versus time and y- 
position versus time) (note: we made it a link so you won't see the results and spoil part 
1). 

Based on this data is the motion model accurate? What are some potential sources of mismatch 
between the model and the experimental results? If you were going to revise your motion 
model, what might you change? 


Exercise 17.6 


For this exercise, we would like you to run the experiment described in the previous problem on one 
of your computers. (detailed instructions on how to run the experiment are given below). 


+ To startup the simulator, open MATLAB and navigate to Shared 
QEASimulatorsV2 in your MATLAB Drive (if you have never gotten the simulator work- 
ing before, go to the Meeto your Neato page). 


Start the simulator by running the following command in the MATLAB command window: 
>> qeasim start empty_no_spawn 


Run the function runBasicWheelVelocityExperiment to execute the experiment 
and generate plots. The script sends messages back and forth to the different nodes through 
ROS topics. Note: we are not expecting you to be able to read through the code in that script 
at this time. This is not something we have taught you yet and you should not feel like it is 
something you should know how to do (yet). 


Other (fun) stuff to try. 


- Try different wheel velocities by specifying inputs to the function (e.g., 
runBasicWheelVelocityExperiment (1.0, 0.8) would drive the left 
wheel with velocity 1.0m/s and the right wheel with velocity 0.8m/s). 


+ Load the ice rink world by executing step 2 above but replacing gauntlet_no_spawn with 
ice_rink. In this new world, see what happens if you drive the wheels too fast! 
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Solution 17.1 







































































Solution 17.2 
Let’s take the case where Vz = Vr > 0. We know intuitively in this case that the NEATO will be 
moving forward at V = V;, = Vr. Using the equation for V above, we get, 


Vi + Vr 2Vi, 
y =>S SO Ss —_ = V, 
2 : = 
Let’s take another case where V_ = —Vp and Vz, < 0. In this case, we know intuitively that the 


forward motion of the NEATO stops and it is simply spinning to the left about its center (when 
viewed from the top—counter clockwise). The velocity is then, 
Va, +=Va 


——————— 


Let’s use the same scenarios for computing w. We find that for Vr = Vr, 


(ene 
= —_—— = 90 
. r 


In other words, the NEATO is traveling in a straight line. That checks out. What about V; = —Vr 
and Vz; < 0? We know intuitive that this result in a counter clockwise rotation about the NEATO 
center and therefore w > 0. We get the magnitude w from, 


ee )2~SCOat=<C=S:sé‘ 


Because Vz, < 0, we can picture this motion, if viewing the NEATO along its y-axis, as 
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The wheel turns at a rate of w= ae For uniform circular motion, where w is a constant value, w= ve 


The linear velocity would be the distance covered in the At, which would be v = “SS. giving, 
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Solution 17.3 


Our goal will be to eliminate V; from Equations 17.1 and 17.2. We can do this by solving each 
equation for V;, and then equating the two results. 





Vi+V; 
V= i Starting from Equation 17.1 
2V =V,+Vpr 
2V —VrR=Vi 
w= ee Starting from Equation 17.2 
dw = Vr = Vr 
Vr —dw= Vr 
Vr—-dw=2V—VpR_ Equating our two expressions for Vz, 
2Vr=2V +d 
d 
Vr=Vt 3 
To get an expression for Vz, we can follow the same strategy, but solve each equation for Vr. 
V= atk Starting from Equation 17.1 
2V =V_+VrR 
2V —Vr_ = Vr 
w= “aa Starting from Equation 17.2 
dw = Vr = Vr 
Vr + dw = Vr 
Vi +dw =2V—V; Equating our two expressions for Vz, 
2V, =2V—d 
d 
Vi — V 9 


To sanity check our solution, we could set w = 0 and observe that this would result in both wheels 
being commanded to move at the same velocity. For a positive w we have that the right wheel goes 
faster, which makes sense since it is on the outside of a counterclockwise turn. 


Solution 17.4 


1. A reasonable experiment would be to set Vz = 0.1m/s and Vp = 0.2m/s. If we let the robot 
travel with these velocities for some amount of time, e.g., 30 seconds, we would expect it to 
trace out a circular path in the counterclockwise direction. 


2. We would expect the resultant path to be a counterclockwise circle. Given d = 0.2m we expect 


w = 2m/s—Olm/s _ 0.5rad/s. It would take the Neato 


20 
0.2m 0.5rad/s 
full trip around the circle. Further, we expect the linear speed to be 0.15m/s. Given this we 
would expect the circumference of the circle the Neato traces to be 0.67 and the radius to be 


0.3 m. 


= 47 seconds to make a 


3. In this case we would expect the Neato to travel in a tighter circle since w will be larger. 


4. We could compute the radius of the circle the Neato actually drives and compare it to the 
predicted radius. We could also compare the time it takes to complete a traversal of the full 
circle to the predicted value. 
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5. This experiment will tell us a fair amount. We wouldn’t be able to distinguish between the case 
where one wheel is underpowered (e.g., the hypothetical case posed above) or the wheel base 
being measured incorrectly. To distinguish between these two cases, we could add an additional 
experiment of having the robot drive straight for some time to see if it fits predictions. 


Solution 17.5 


1. Using the same logic as in the solution to the previous problem, we'd expect the Neato to travel 
around a circle of radius 0.3m with a period of 47 seconds. The only difference is the Neato 
will now be moving in clockwise direction. 


2. The experimental data doesn’t match the prediction as well as we might look since the measured 
radius of the circle the Neato moves around is about 0.35m. Perhaps the wheel base is incorrect? 


Solution 17.6 


There’s no solution to this problem. We want you to verify that the simulator is working on your 
computer and get comfortable interacting with the robot. 
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Robo Homework 2: Angular Velocity, 
NEATOs, and Partial Derivatives 
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? Learning Objectives 


Concepts 


« Predict the direction of w based on an object’s space curve. 

+ Compute the partial derivatives of functions of more than one variable. 
Matlab Skills 

+ Compute an object’s motion properties from its parametric vector function. 


¢ Use basic ROS commands to send instructions and receive sensor data from a simulated NEATO. 


18.1 Angular Velocity Revisited 


Suppose we have a 2D parametric curve r(t) = f(t)i + g(t)j. We saw in the week 1 homework assignment 
that the linear velocity vector is given by r’(t) = f’(t)i + g'(t)j. 

Determining the expression for the angular velocity w(t) of our robot is more involved. Before we derive 
the correct expression, we will revisit the notion of angular velocity vectors. In week 1 of this module you 
encountered this idea when you experimented viewing the components of the angular velocity vector in 
a mobile app. Here, we'll expand on it further. While expressing angular velocity as a vector may seem 
overly complex. Since the robot moves on a 2D plane, we know that the robot will rotate about the z-axis, 
and it seems like we should just be able to compute the scalar magnitude and whether to turn clockwise or 
counterclockwise. However, thinking about the angular velocity as a vector will enable our derivation to be 
done in a much more straightforward and generalizable manner. 

Angular velocity vectors point in the direction of the axis about which the body rotates (for our robot, 
either the positive or negative z-axis). For right-handed coordinate systems (such as the one we are using 
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here), a positive rotation happens counterclockwise about the direction of the rotation axis. The magnitude 
of the angular velocity vector indicates the speed of rotation. 

Earlier this week, we discussed the coordinate system attached to the robot: the body fixed frame. Because 
the heading of the robot is locked to the tangent vector T of the curve, we can think of the vector T as being 
a constant in the body fixed frame of the robot. The body fixed frame is rotating with some unknown angular 
velocity vector w with respect to the room coordinate system. If we wish to know the time derivative of the 
tangent vector T in the room coordinate system, we can use the generalized relationship between the time 
derivatives of vectors in two coordinate systems which are rotating with an angular velocity vector w with 
respect to each other. This expression is 

dT dT - 
“Rlreom = “I body +w x T (18.1) 

(Full mathematical derivation here; nice heuristic explanation here.) In the body frame of the robot, T is 
unchanging, since it is always aligned with the forward direction, so the term um lbody is zero leaving us with 

dT 


“jy lreom =wxT (18.2) 


Next we can make use of the scalar triple product, which states that a x (b x c) = b(a-c) — c(a- b). 
Using this we can derive our angular velocity vector as follows 


dT : 
——|-n0r =wxT 


+ ut F 4 
T x —|-00om = T xX w x T 
dt 


~ dT 
=T room 8. 
> w x ae (18.3) 


The x and y components of the angular velocity vector will always be zero because T and ~ |-oom are in 
the x-y plane and orthogonal. The magnitude of the z-component is the angular speed. If the z-component 
is positive, we turn counterclockwise at that speed. When it is negative, we turn clockwise at that speed. 


Exercise 18.1 
In the Week 1 homework assignment you found the unit tangent and normal vectors for various 
parameterized curves. We will use that information to find linear and angular velocities, then 
translate those to left and right wheel velocities for the NEATO. 
The vector for a circle centered at the origin in the x-y plane is given by: 


r(t) = Reosat i+ Rsinatj + 0k 


We will make the following assumptions about our parameters: 
+ t starts at o seconds and increases with time (r(t) gives us the Neato’s position at time ft). 
+ R > 0 and provides the radius of the circle. 
* acan be positive or negative (we'll ask you to interpret its meaning later in the problem). 


If you decide to work in MATLAB (either to check your solutions or to do the problems), we'd advise 
you to build off the your code from last week’s assignment (or use the starter code provided in 
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that assignment). If you’re finding your answers are not in a form that you expect, considering the 
following hints. 


Specify assumptions (e.g., t, a, R are all real and R > 0,t > 0). Note as stated above: a does 
not have to be positive. 


Use the MATIAB function simplify on your answer. 


. How does the sign of a affect the path that the Neato takes around the circle? 


. What are the linear velocity vector and linear speed? 


. What is the unit tangent vector for the circle? Make sure your answer makes sense for both 


positive and negative values of a. 


. What is the unit normal vector? 


. What is the angular velocity vector? 


. For the uniform circular motion we have been investigating so far, what does the parameter 


we have labeled a represent? How is it related to the time it takes to complete one traverse of 
the circular trajectory? 


. How would you modify the initial equation for the position vector when its trace is circle of 


radius 1m? 


. What value would you choose for a if you want your robot to complete a counterclockwise 


path around the circle in 30 seconds? 


. What are the equations for the left and right wheel velocities for the uniform circle? (d=wheel 


displacement). You can leave your answer in terms of d or substitute a reasonable value for 
the Neato of d = 0.235m. 


. What are the left and right wheel velocities needed for a 1 m radius counterclockwise circle to 


be completed in 30 seconds? 


Exercise 18.2 


The vector for a counterclockwise path around an ellipse is given by: 


r(t) = acosati+ bsinatj, at € [0,27] 


In this problem we can assume that a, a, b are all positive and that t > 0. 


1. 


What is the tangent vector for the ellipse? 


. What is the unit tangent vector for the ellipse? 


. What is the linear velocity vector? How does it differ from the example of the circle? 


. What is the unit normal vector? 


. What is the angular velocity vector? How does it differ from the circle? 


. What are the left and right wheel velocities? 
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7. Plot the linear velocity vector as a function of time for various combinations of the parameters 
a, b, and a. 


8. Plot the angular velocity vector as a function of time for various combinations of the parameters 


a, b, and a. 


9. Plot the left and right wheel velocities as a function of time for various combinations of the 
parameters a, b, and a. 


CO 


18.2 Fun with (Simulated) NEATOs 





In the previous section we found the left and right wheel velocities needed to drive a particular trajectory. In 
this section of the assignment, we will be thinking about how to translate the velocity vectors to a Matlab 
program that will control your NEATO. 

The control of your NEATO is built on top of the Robotic Operating System (ROS), so you will be using 
ROS commands to control the velocity values for your robot. Prior to starting this section, you will need to 
have completed the setup steps in Meeto Your Neato 

Here, we will start by playing with some very basic commands. Consider the program drivefoward.m. 

This code snippet defines the function “driveforward” which will cause your NEATO to.... you guessed it, 
drive forward. You will notice that this function does not have a meaningful output, its sole purpose is to 
move your robot forward. 


18.2.1 The structure of a Simple Robot Program 


While the program has lots of comments, we elaborate on specific lines of the code to help you understand 
its structure on this page. Please read through the notes. 


Exercise 18.3 


driveforward is a Matlab function that can be called from the command window using the 
form: 


driveforward(distance, speed) 


where distance and speed are the numerical values that you give to the function 
driveforward. The function is built into the simulator, so you don’t have to download it, 
but 


- To startup the simulator so you can test the driveforward command, open MATLAB 
and navigate to Shared 
QEASimulatorsV2 in your MATLAB Drive. 


» Start the simulator by running the following command in the MATLAB command window: 


>> qeasim start empty_no_spawn 


Using the driveforward(distance, speed) function, try driving the NEATO for several 
combinations of distances and speeds (Remember to specify values for distance (in meters) and 
speed (in m/s). Do the final distance and time match your expectations? Note that squares of the 
grid on the simulator visualization are 1 meter by 1 meter. 
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18.2.2 Receiving Sensor Data 


In the previous example program we published to a ROS topic to set the NEATO wheel velocities. In ROS 
you can also subscribe to a topic to do things like receive sensor data. Download and open the program 
driveUntilBump in Matlab. 


Exercise 18.4 
To be successful in this exercise, you should have the simulator up and running, e.g., using the proce- 
dure described in the previous exercise. Instead of the ‘“empty_no_spawn’ simulator environment, 
you should use the command: 


qeasim start gauntlet_final 


You can think of ROS topics as some aspect in your robot environment, such as the robot’s odometer 
readings. Any node (i.e., software program) in the ROS environment can publish information to the 
topics or subscribe to a topic. The Master contains a list of the available topics and node publishers 
and subscribers. 


1. In line 2 of driveUntilBump, the ‘rossubscriber’ command is introduced; it requires that you 
pass it the ‘topic’ that you want to subscribe to. For a list of active topics, in the MATLAB 
command window, type, 


rostopic list 


From the code, what sensor output topic are we monitoring? Note: You can see what the name 
of it is, but it’s pretty hard to figure this out with the simulator since there is no way to actually 
physically touch the robot, just look at the solution for this one! 


. The variable bumpMessage is a structure. You might recall that a structure is a type of object 
that has properties. What topic provides the data for bumpMessage? 


The data in the property can be accessed by referring to its name, e.g., bumpMessage. Data. 
If you are interested in seeing how to drill down on the information in a rostopic, here is an 
example of the MATLAB commands, accessingROS.pdf 


What is the size of ‘bumpMessage.Data’? What do the values contained in that variable mean? 
Note: it’s pretty hard to figure this out with the simulator since there is no way to actually 
physically touch the robot, just look at the solution for this one! 


. What is the ‘driveUntilBump’ code commanding the robot to do? 


. Test the ‘driveUntilBump’ code on a NEATO and verify that your interpretation is correct. 
. Modify the ‘driveUntilBump’ code to make it a function where the robot velocity is an input. 


. Using what you have learned from the examples above, write a program that meets the 
following requirements: 


+ The program commands the robot to drive a designated distance at a chosen speed, and 
stops when that distance is reached. 

» Ifthe bump sensor is triggered, the robot reverses direction and backs up for 5 seconds 
then stops. 


Try developing this code on your own first, then if you get stuck, take a look at the program 
driveUntilBumpThenRunAway and this driveforward for inspiration. You may also find this 
video on rostic and rostoc to be helpful. 
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18.3. Partial Derivatives 


The following notes about Partial Derivatives might be helpful. Mark has also put together videos on this 
topic. You can check your calculations using WolframAlpha or the Symbolic Toolbox in Matlab. 

Consider a function of two variables f(x,y). If we identify z = f(x,y), then we can visualize this 
function as a surface in 3D. At any point on the surface, (a, b, c), we can ask about the slope of the tangent 
line in the x-direction and in the y-direction. In the first case, we intersect the surface with the plane y = b 
and consider the rate of change of f in the x-direction only. In the second case, we use the plane 7 = a and 
consider the rate of change of f in the y-direction only. There are therefore two fundamental derivatives, 

ot is the partial derivative of f with respect to x 
of is the partial derivative of f with respect to y 





Figure 18.1: Partial derivatives of a function of two variables. 


In each case we compute the derivative with respect to one variable by holding the other one fixed, i.e. 
treating it as a constant. 


Exercise 18.5 


Evaluate ot and ge for each of the following functions. 


eee | 


2. f(t,y) =4+2° +y° — 3zy 





es) 


We can also evaluate higher-order derivatives, but now there are several possibilities. We could take two 
derivatives with respect to 2, 
oof OF 
Ox Ox Ox?” 
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We could take two derivatives with respect to y, 





OOF OT 
Oy Oy — Ay?’ 
Or we could take a derivative with respect to x and then with respect to y, and vice versa, 
oar _ &f 
Oy Ox ~~ OyOx 
OOF OF 
Ox Oy OxOy’ 
In all of the functions that we will be dealing with, the mixed partials are equal 
OS OS, 
OyOx = Oxdy" 


Exercise 18.6 


Evaluate all four second-order derivatives of the following functions. What do you notice about the 
mixed partial derivatives? 


1. f(a, y) = x? sin(zy’) 
7s ieee Tee Set) eh 


Ce) 


Under very gentle conditions it is generally true that the mixed partial-derivatives are always equal, i.e. 





of of 


OyOx Oxdy 


Exercise 18.7 


Using the power of the internet, under what conditions are the mixed partial derivatives of f equal? 


a) 


18.3.1 The Gradient and the Hessian 





We've seen that a function of two variables, f(x,y), has two partial derivatives, of and ee Rather than 
thinking of these separately, we can package them into a vector known as the gradient vector. In terms of 


notation we write 
of 
oF 
Oy 


Exercise 18.8 


Vf= 
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Find the gradient vector of the function f(x,y) = 327y + y® — 3x? — 3y? + 2 by hand and check 


your answer using WolframAlpha or the Symbolic Toolbox in Matlab. Evaluate it at the point (1, 2). 


—————E SS ee) 


In the same vein, we can package the four second-order partial derivatives into a matrix called the 
Hessian matrix. In terms of notation we write 











of orf 
2 
a Bey ‘oy 
OyOx Oy? 


Exercise 18.9 


Find the Hessian matrix of the function f(a, y) = 3x?y + y® — 3x? — 3y? + 2 by hand and check 
your answer using WolframAlpha or the Symbolic Toolbox in MATLAB. Evaluate it at the point 


(au 
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Solution 18.1 


1. A positive value of a corresponds to a counterclockwise path around the circle, whereas a 
negative value of a corresponds to a clockwise path. 


2. The linear velocity vector is given by v(t) = r/(t) = a’ (t)i+y/ (t)j+z' (t)k or v(t) = v(t) T(t). 
For the case of the circle, we know: 


r’(t) = —Rasinati+ Racosatj 


So, the linear velocity vector is v(t) = aR(—sinat i+ cosat j) and the magnitude 
(linear speed) is v(t) = |a|R in units of 


|B 


3. The unit tangent vector is: 


bs y’ 


Ir 
os ea, , 
= —-—~sinat1i+ — cosatj 


la| la) 


Note that the quantity ial gives us the sign of a. This means that if we negate a that will 
cause T to negate as well (corresponding to, as we would expect, moving about the circle in 


the opposite direction). 


4. The unit normal vector is 


‘ T’ 
N a 
[| 

—cosati—sinatj 


5. The angular velocity is constant: w = ak. 


6. The parameter a is the angular frequency of motion, often denoted by the scalar w (we'll use 
a here since we are already using w for the angular velocity vector). For a uniform circular 
motion, the frequency and angular velocity are equal. The time to complete one traverse of 
the circle is given by the period T = 2% 


lol" 
7. Set R=1m 


8. For a positive value of a (corresponding to a counterclockwise path) we know that the product 
at must go from 0 to 27 for the robot to complete one cycle of the parameterized curve. So, 
20 


after one complete trip around the circle, aT’ = 27, soa = r= 0.21 with units q. 


9. We can use the equations from Day 2 of the module that relate left and right wheel velocities 
to linear speed and angular velocity. Plugging the expressions for linear speed and angular 
velocity that we found earlier in this exercise into those equations we arrive at 


da 
Vi = Rial = cy 

and r 
tex Riale 7 


Note: that for the simulated Neato (and the real Neato), the wheel base is approximately 
d = 0.235m. 
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10. 


1. 








da 
Vi = Ra = - 
1\ — (0.235m)(0.214 
= (1m) (o.21 ) eras a 
8 2 
= 0.185— 
Ss 
d 
Vr = Ra+ = 
1 0.235m)(0.214 
= fim) (o21 ) Pe ite ae 
Ss 2 
= 0.235— (18.4) 
§ 


Solution 18.2 


What is the unit tangent vector for the ellipse? An altered version of the the symbolic MATLAB 
starter code is here: link. This code computes almost all the needed properties (T, etc.), but I 
have to change the parameters to fit the ellipse. In my code, I used ’w’ for a. Here is a MATLAB 
solution. When you run the MATLAB code, you will see that if you substituted a for ’w’ in 
the code and used the trigonometric identity, cos*(9) = 1 — sin*(0), the unit tangent vector 
reduces to, 


—asin(at) " bcos(at) 
i 
\/a?sin?(at) + b2cos?(at) —_\/a? sin? (at) + bcos? (at)’ 





T= 





. What is the unit normal vector? See N in the output of the MATLAB code. Using the trig 


identity above, you will get a ’simplified’ N, 


; —bcos(at) ‘4 


_ ; —asin(at) 
/a?sin2(at) + b?cos2(at) a? sin? (at) + eer 








. What is the angular velocity vector? How does it differ from the circle? See w in the output 


below. Because the NEATO motion is confined to the xy-plane, the angular velocity vector is 


coincident with the +k. However, unlike the circle, which has a constant a the |w| = f(t): 


_ aba é 
a2 sin? (at) + b?cos?(at) 





For both the circle and the ellipse, w > 0, since the motion in counter clockwise. Note:I’ve 
used the trigonometric identity, cos?(@) = 1 — sin?(@), so your MATLAB output might look 
slightly different. 


. What are the left and right wheel velocities? Using the equations, from Day 2 we have, 


d 

y= V-w, (18.5) 
d 

Vr = oe, (18.6) 


In order to map what we’ve been doing in this document to these equations, we can keep in 
mind the following. 
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* w (notice that w is not bolded and refers to a scalar) represents the component of the 
angular velocity in the k direction 


 V is the linear speed, which is given as |r’(t)]. 











d 
‘== We (18.7) 
= av/a?sin(at)? + b2cos(at)? = : (18.8) 
a?sin? (at) + b2cos?(at) 2 
Ve=V+ ws (18.9) 
aba d 
= av/a*sin(at)? + b?cos(at)? 4 (18.10) 





a?sin? (at) + b?cos?(at) 2 


5. Plot the linear velocity vector as a function of time for various combinations of the parameters 
a, b, and a. When you do this, you will see that the trace of the linear velocity function vector 
follows the same path as the space curve, r(t), but is shifted in phase by 5. We say that r’(t) 
leads r(t) because at at = 0, r’(t) is positioned at 5 radians ahead of r(t). 


6. Plot the angular velocity vector as a function of time for various combinations of the parameters 
a, b, and a. Because r(t) is constrained to counterclockwise motion in the xy-plane, w > 0 
and in the direction of k. Its magnitude varies with the choice of parameters. For a = 1,b = 
20= on, a complete rotation of r(t) around the ellipse takes takes 10 seconds. The trace of 
r’(t) will follow the same ellipse, starting at r’(0) = (0, 2) and ending at r’(10) = (0, 2) 








7. Plot the left and right wheel velocities as a function of time for various combinations of the 
parameters a, b, and a. Choosing a = 1 and b = 2 anda = Zz, gives 


Vv(m/s) 


gt NUT) | | ant be 2, alpha=2n/10 
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Regardless of the combinations of the parameters, as long as the NEATO is moving in the 
counterclockwise direction, V, < Vp. 


Solution 18.3 


The behavior of the actual should match closely with your expectations. However, notice the 
Realtime and Simtime in the simulator. Your Simtime will be less than your Realtime if 
your computer’s processor is slow-This difference between simulated and real time should be taken 
into account when programming the robot. We have provided the functions rost ic and rostoc 
that should work well for this purpose, however, if you want to access the simulator time directly you 
can use the rost ime command in MATLAB. For example, in a MATLAB script, you can assign, 


time = rostime('now' ) 


This command assigns the rostime object to t ime. You can get the integer values of the simulated 
time in seconds (time. Sec) and nanoseconds (time .Nsec). However, it’s better to directly 
access the simulation time in seconds as a double-precision array by using, 


time.seconds 


Don’t forget that the robot has a maximum velocity! 


Solution 18.4 


1. From the code, what sensor output topic are we monitoring? 

We are monitoring the output of the Neato’s bump sensor (which is located at the front of the 
robot and triggers when the front of the robot contacts something). 

2. What is the size of ‘bumpMessage.Data’? What do the values contained in that variable mean? 
The variable ‘bumpMessage.Data’ contains four numbers, one for each of the Neato’s bump 
sensors. Note that in the simulated Neato the bump sensors are either all on or all off. 

3. What is the ‘driveUntilBump’ code commanding the robot to do? 

The code tells the robot to drive forward with velocity of 0.1 m/s until it runs into something 
and then stops. 

4. Test the ‘driveUntilBump’ code on a NEATO and verify that your interpretation is correct. 


You should run the code in the Robot simulator and observe the behavior. In the ‘gauntlet_final’ 
environment, you will notice several obstacles and concrete barriers. Based on the initial 
orientation of the Neato, you should observe the robot drive forward until it collides with a 
concrete barrier, then stop. You will also notice the *bumpMessage’ structure in your Matlab 
Workspace after the collision. 


5. Modify the ‘driveUntilBump’ code to make it a function where the robot velocity is an input. 
An example solution code is here: driveUntilBumpWithVelInput. 


6. Using what you have learned from the examples above, write a program that meets the 
following requirements: 


« The program commands the robot to drive a designated distance at a chosen speed, and 
stops when that distance is reached. 


« Ifthe bump sensor is triggered, the robot reverses direction and backs up for 5 seconds 
then stops. 


Try developing this code on your own first, then if you get stuck, take a look at the program 
driveUntilBumpThenRunAway and this driveforward code for inspiration. You may also find 
this video on rostic and rostoc to be helpful. 
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Of 
Ox 
Of 
Oy 


Of 
Ox? 
Of 
Oy? 
Of 
OyOu 
Of 
OxdOy 








Solution 18.5 


2x sin(ay”) + xy? cos(xy”) 


2x y cos(axy”) 
OF = etd 
= 3x" — 3y 
OF =) ae 


Solution 18.6 


(2 — 2y*) sin(xy?) + 4xy?cos(xy?) 
2x? cos(xy”) — 4a*y? sin(xy”) 
6x*y cos(xy”) — 2a y? sin(ay”) 


6x7y cos(xy”) — 2a y? sin(ay”) 


As we would expect, the mixed partial derivatives are equal. 








On F 
ge 
Oo? f 
ap ~ 
2 
O° f ee oh 
OyOu 
2 
Of = 
OxOy 


As we would expect, the mixed partial derivatives are equal. 


Solution 18.7 


If the derivatives exist and are continuous then they are equal. See Paul’s Online Math Notes about 


this. 


Let’s first evaluate the first-derivatives: 


of 
ax 
of 
dy 


Solution 18.8 


= 6ry— 6x 


= 32° + 3y? —6y 
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and then we simply package them into a vector 


_ 6xy — 6x 
Mi se + 3y? — ‘ 


If we evaluate the gradient vector at (1,2) we see that 


vri2)= [jl 


Solution 18.9 


Let’s first evaluate the second-derivatives: 








a = b6y-—6 
rs = 6y-—6 
2 
a =. 
2 
i as 


and then we simply package them into a matrix 


_[ey—-6 62 
Hf=| 6x ar 


Note that we expect the Hessian to be symmetric because the mixed partials are equal. If we evaluate 
the Hessian matrix at (1,2) we see that 


#70,2)=|§ 6 
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Robo Week ga: Introduction to 
Encoders 
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? Learning Objectives 


« Calculate the linear and angular velocity of a rigid body traveling along a trajectory described 
by a parametric curve. 


« Relate the wheel velocities of a differential drive robot to the robot’s linear and angular velocity. 


« Reconstruct the path of a robot based on encoder measurements. 


19.1 Debrief and Synthesis 


We have covered a lot of conceptual material during the first two weeks of the Robo module. We would like 
you to take the first half of today’s class to check in on your understanding and review some key concepts. 


Exercise 19.1 
During class and in the overnight exercises we have been building capacity towards having the 
NEATO robot drive along a curve. Of course there are lots of different ways to parameterize a curve, 
each of which would correspond to different motion of the NEATO. Let’s take a few minutes to 
review those concepts here. With your group, please answer the following questions given a circle 
of radius R, 


r(u) = Rcosui + Rsinuj, u € (0, 27] 


and the following parameterizations cases: 
u(t) = Bt 
u(t) Bt? 
u(t) 


where § > 0 is a parameter that we can tune. 





185 


CHAPTER 19. ROBO WEEK 3A: INTRODUCTION TO ENCODERS 186 


. Qualitatively describe the motion of the NEATO in each case. A sketch could be useful. 


. How long does it take to traverse the curve once? (Hints: Your answer should depend on /. If 
the answer cannot be determined symbolically, indicate how you could go about solving it.) 


. How would you find the linear velocity of a robot traveling along the curve? What is the 
direction of this velocity? (It would be really great if you employed the chain rule here and 
kept your work as general as possible.) 


. How would you find the angular velocity? What is the direction of the angular velocity? (It 
would be really great if you employed the chain rule here and kept your work as general as 
possible.) 


. Having found the linear and angular velocity, how would you find the left and right wheel 
speeds for the differential drive? 


. The robot has a maximum wheel speed of 0.3 m/s. How would you choose ( to ensure your 
robot never exceeds this speed limit? 





19.2 Measured Paths 


One potential source of error when working with a real robot, is that the robot is not able to instantaneously 
achieve a desired V;, and Vp when you send it a particular motor command. Given the pesky laws of physics, 
the robot instead needs to accelerate to the desired velocity. In order to get a more accurate picture of 
what the robot actually did, we can use measurements of the wheel velocities to give us a more accurate 
estimate of the robot’s actual path in the world. Our Neatos (both real and virtual) are outfitted with sensors 
called wheel encoders, which provide accurate estimates of the linear travel of each wheel over time. For a 
nice introduction to encoders and how they work, check out this video from Sparkfun. Knowing the linear 
travel and the time between measurements, the velocity of each wheel can be calculated. Next, you'll be 
determining formulas to update the robot’s position and heading given measured values of Vz and Vp. 


Exercise 19.2 
Suppose that at time t your robot is at position r(t), with a heading of @(t). Let’s further assume 
that at t = 0 the robot is stationary and pointing along 0 = 0, which corresponds to the robot facing 
along the positive x-axis of the room. 


1. Draw a picture to make sure that you are clear as to the definition of the coordinate system. 


2. Sketch a (fairly smooth) potential trajectory that your robot will be driving. Choose several 
points along the curve separated by At. Sketch in the unit tangent and unit normal vector at 
each point. 


. Sketch an estimated plot of your robot’s linear and angular speeds as a function of time as it 
traverses your curve. 


. Sketch an estimated plot of your robot’s tangential and normal components of acceleration as 
a function of time as it traverses your curve. 


. Sketch a qualitative version of your estimate of right and left wheel velocity as a function of 
time. 
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Exercise 19.3 


For a discretized path (expressed in terms of short time increments rather than continuously) you 
can, assuming that the time-step At is small, approximate a path by a series of movements in r and 
movements about the center of the robot in 9. The velocity of the robot is 


dr 
dt 
do 
dt 


vT 


= Ww 


where v is the linear speed, w is the angular velocity in the k direction, and since the robot is always 
oriented along the path we can define T in relation to the global (classroom fixed) coordinate system 
as 


T =cos6i-+ sin 6j 


Given measured values for Vz and Vr determine the values of r(t + At), and 6(¢ + At) which 
represent the position and heading of your robot at time ¢ + At. 


a) 


19.3. Introduction to the Bridge of Doom 





Challenge one for the robotics module is the Bridge of Doom. Successfully complete this challenge, you 
will need to command your robot to traverse a bridge described by a parametric curve. The Bridge of Doom 
challenge can be found in Chapter 21, and we encourage you to start working on the path planning portions 
of the challenge after today’s class. 
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Solution 19.1 
1. Qualitatively describe the motion of the NEATO in each case. 


(a) For the parameterization u(t) = {t, the NEATO drives around the circle described by 
r(u) at a constant velocity. The velocity of the NEATO will be impacted by the choice of 
i. 

(b) For the parameterization u(t) = Bt?, the NEATO drives around the circle described by 
r(w) with an increasing velocity due to the ¢? term in the parameterization. 


(c) For the parameterization u(t) = 6(2 + sin(t))t, the NEATO will travel around the circle 
described by r(u), but the velocity will oscillate between positive and negative, causing 
the robot to actually backup along the path at times. 


2. How long does it take to traverse the curve once? (Your answer should depend on f If the 
answer cannot be determined symbolically, indicate how you could go about solving it.) To 
traverse the circle once, the parameter u must travel from o to 27. Therefore, to determine the 
time to complete a traverse, we must solve for ¢ in each of the parameterizations, and plug in 
u=2n. 


(a) For the parameterization u(t) = Gt, t = ae SO tpmat = ve 





(b) For the parameterization u(t) = 6t?, t = UT) 50 tiimat = + ee Note that this time 
is less than the previous parameterization. This makes sense since the robot is speeding 
up throughout the traverse of the curve. 


Be a 


(c) For the parameterization u(t) = 8(2 + sin(t))t, “— = 2 + sin(t), so = = 


Bt final 
sin(t final). This can be solved using Matlab or any other numerical solver. 





3. How would you find the linear velocity of a robot traveling along the curve? What is the 
direction of this velocity? (It would be really great if you employed the chain rule here and 
kept your work as general as possible.) The linear velocity would be found by 


v(t) = < tr(u(t)) = r'(u(t))u'(t) 


after applying the chain rule. For the function 
r(u(t)) = Reos(u(t))i + Rsin(u(t))j, 


we can write 
£ x(u(t)) = —Rsin(u(t))w’ (t)i + Reos(u(t))u’(t)j 


where P 
f = — 
a(t) = 2 u(t). 


The velocity is in the direction of the unit tangent vector 


© _ —Rsin(u(t))u'(t)i + Rcos(u(t))u'()j 
Ir’| Ru’ (t) 





= —sin(u(t))é + cos(u(t))j 


4. How would you find the angular velocity? What is the direction of the angular velocity? (It 
would be really great if you employed the chain rule here and kept your work as general as 


possible.) The angular velocity can be found as w = T x a |room which simplifies to wu’ (t)k. 





The angular velocity will always be in the +k direction. Positive k indicates a counterclockwise 
rotation, while negative k indicates a clockwise rotation. 
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5. Having found the linear and angular velocity, how would you find the left and right wheel 
speeds for the differential drive? 


d 

‘= Vai (19.1) 
d 

Va= ¥ pits (19.2) 


6. The robot has a maximum wheel speed of 0.3 m/s. How would you choose / to ensure your 
robot never exceeds this speed limit? 
We know from above that 4r(u(t)) = —Rsin(u(t))u’ (t)i+ Rcos(u(t))w’ (t)j, and the magni- 
tude of the linear velocity is |r’(u(t))| = Ru’ (t)|. We also know that |w| = |w’(£)|. Combining 
this with the equations for left and right wheel velocity above, we would choose £ so: 


0.3 > Ru’ (t) — w'(O15 (19.3) 
03 > Rul(t) + WIS (19.4) 


Solution 19.2 


Solutions to this exercise will vary by breakout room based on your robot’s trajectory. 


Solution 19.3 
Given measured values for Vz and Vp determine the values of r(t + At), and 0(t + At) which 
represent the position and heading of your robot at time t + At. 
Conceptually, we can think about the robot making discrete moves in space over the period At. Each 
of these moves would consist of a translation and a rotation. From Vz, and Vp, we can find the linear 
and angular velocities as: 
_ Vet Va 
oe 
_ Va= Vz 
7 d 
With these velocities, for a robot initially at position r(t) = x(t)i + y(t)J in the global frame, we 
can then say: 


V 





dr 
r(t+At) = r(t)+ ao 
r(it+At) = r(t)+vTAt 
r(t+At) = (x(t) +V cos(6(t))At)é + (y(t) + V sin(0(t))At)j 


To fully define the position of the robot, we must know its orientation 6(t) with respect to the global 
reference frame, in addition to its position r(t): 


O(t+At) = a(t) + Fat 


O(t+At) = O(t)+wAt 
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Robo Week 3b: Measured Paths 





Schedule 
20.1 Encoders in Action ........ 0... eee ee et et et eee 187 
20.1.1 Finding Wheel Velocities .. 1... 0... ee ee 189 
20:2. Encoder Experiments:......... 6.06050: 0. see ee 190 
20.%.1 Optional Extension: Encoders in Real-Time . 2.4.06 04 nee ey ee es 191 
20.3 Crossing the Bridge of Doom- Robot Code and Mapping ............... 191 





? Learning Objectives 


« Relate the wheel velocities of a differential drive robot to the robot’s linear and angular velocity. 
« Reconstruct the path of a robot based on encoder measurements. 


« Explore sources of error (e.g. wheel slippage) between encoder output and the motion of a 
robot. 


20.1 Encoders in Action 


During class today you will complete a series of simple experiments with the NEATO while simultaneously 
collecting motion data. In order to do this, we have provided you a web-based tool for collecting the wheel 
position encoder data while you are running your experiment. 


Exercise 20.1 


Watch the video demonstrating how to collect a simulated encoder dataset here. Once you have 
watched the video, try collecting a sample dataset by completing the following steps: 


1. Open the robo simulator by running the command: 


qeasim start empty_no_spawn 


2. With the simulator running visit the following link encoder_dataset_collector. This will open 
the web-based data collection tool in your local browser. Make sure you see “Connection 
Status: connected” 
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Encoder Dataset Collector 


Datapoints Collected: 141 








(| Connection Status: connected 





3. Click the “start collecting data” button to begin collecting wheel encoder data. You should see 
the number of “Datapoints Collected” begin to increase. 







Encoder Dataset Collector 






Dagaeew= ed: 141 





[ Start Collecting Data | Pownload Dataset || Reset Dataset | 


ffus: connected 


4. Run a basic robot experiment by running the following command in your browser-based 
Matlab: 


runBasicWheelVelocityExperiment 


5. When your robot has stopped moving, stop data collection using the “Stop Data Collection” 
button, then download the dataset using the “Download Dataset” button. 








6. After you complete your experiment and download your data, you can reset the dataset using 
the “Reset Dataset” button. 


7. Load the collected data into your local Matlab by drag and dropping the “my_data.csv” file 
into the command window. This will bring up the Matlab import GUI. You will want to import 
your data as “Column Vectors” as shown in the image below. The default variables names 
will be encoderLeftmeters, encoderRightmeters, and timeseconds. You may choose to rename the 
variables for convenience. 
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& Import - C:\Users\jdusek\Downloads\my_data (1).csv 


IMPORT 





Column delimiters: Ci Replace + unimportable cells with * NaN - 4| ~ 
[eomma . q ras 
° Variable N: Row: |1 al e . 

Fixed Width @ Delimiter Options ~~ proble Nerpes @ Text Options + |B Selection» 
DELIMITERS SELECTION IMPORTED DATA UNIMPORTABLE CELLS IMPORT 
my_data(I).csv | 


© Delimited 








8 
timeseconds encoderLeftmeters encoderRightmeterst 
Number 
encoderLeft (meters) encoderRight (meters) 
(410073071 78835205, 136500605381 16455 
|4.0073957443237305 1,36590576171875 
'4,007394790649414 1,365904450416565 
'4,0073933601379305 1,3659031391143799 
'4.007392406463623 1,3659018278121948 
|4.007390975952148 1,3659005165100098 
'4.007390022277832 1,3658992052078247 
(4.007388591766357 1.3658978939056396 
(4.007387638092041 1,3658967018127441 
(4,007386684417725 1,365895390510559 
'4,00738525390625 1,365694079208374 
4.007384300231934 1,365892767906189 
4.007382869720459 1,365891456604004 
(4.007381916046143 1,3658901453018188 
'4,007380485534668, 1,3658888339996338 
|4.007379531860352 1.3656875226974487 
4.007378101348877 1,3658862113952637 
4.0073771476745605 1.3658850193023682 
|4:007376194000244 1,365883708000183 
21f1061.195 | 4.0073747634287695. 1,365882396697998 




































































8. Plot the left and right wheel encoder linear travel values versus time. You should get a plot 
that looks something like the one below. 


Right Wheel 


Linear Travel [m] 





4 
1055 1060 1065 1070 1075 1080 1085 1090 1095 1100 
Time [s] 





20.1.1 Finding Wheel Velocities 


You can compute the left and right wheel velocities by taking the difference between two consecutive 
distances (e.g. encoder Le ftmeters(4) — encoder Le ftmeters(3)) and dividing it by the time difference 
(timeseconds(4) — timeseconds(3) in this example). The Matlab function diff will likely be useful in this 
process. Note that the robot's initial eencoderLeftmeters and encoderRightmeters values are arbitrary and 
unrelated to x or y coordinates in space. The encoder values represent the linear distance of travel for each 
wheel. 
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20.2 Encoder Experiments 


Complete the following simple experiments. For each experiment, record the encoder data for 
analysis using the encoder_dataset_collector. 


Exercise 20.2 


Using the provided DriveCircles.m function (it is already installed in the simulator, so the link is 
only for reading through the code), have the robot spin counterclockwise for ten seconds, then 
spin clockwise for ten seconds around around the robot’s center (i.e Ve=-Vz or the opposite). The 
function takes inputs of left and right wheel velocity as DriveCircles(vL,vR), and the times are already 
set. Collect and plot the left and right wheel encoder data. 


1. Does the plot of the wheel linear travel look as you would expect? 


2. Find the left and right wheel velocity at each time step and plot them. Do they match your 
expectations? If you know d, you can also find and plot the linear and angular velocity. 


Exercise 20.3 
Using encoder data to reconstruct the position of your robot has limitations- we assume there is a “no 
slip” condition between the wheel and the ground. In other words, the linear travel output from the 
encoder assumes that the wheel moves forward a distance of 7d, where d is the wheel diameter, for 
each revolution. This assumption falls apart if there is slipping between the wheel and the surface. 
Launch the robot simulator using the command: 


qeasim start ice_rink 


Using the driveforward.m function introduced in the overnight, conduct three experiments where 
the robot drives a specified distance at increasing speeds. Collect and plot the encoder data. You 
might want to do “edit -> reset world” in the simulator between experiments. 


1. Does the linear distance traveled collected by the encoders match the distance input to the 
function? How about the distance travelled by the robot in the simulated world? 


2. If the values do not match, why not? 


3. Plot the linear and angular velocity as a function of time. Do they match your expectations? 


Exercise 20.4 
If you have time in class: Calculate the left and right wheel velocities needed to drive a circle 
of radius 0.5m in 20s. Use the code runBasicWheelVelocityExperiment.m drive the circle while 
simultaneously collecting a wheel encoder dataset using encoder_dataset_collector. 


1. Plot the anticipated trajectory of your robot in Matlab. You may want to use the Matlab 
command axis equal to make sure your circle looks nice and circular. 
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2. In the same figure, plot the actual trajectory of your robot. How closely do they match? 


3. Quantifying error is an important part of any experiment. For the circular path, how would you 
calculate error between the anticipated trajectory and the actual path of the robot? Are you 
interested in total accumulated error? Average error and each time step? Distance away from 
the “ideal” curve at each time stop (e.g. are you stying within a lane)? Does something else 
make sense? As a group, draw sketches of what each of these types of error would represent 
visually, and come up with mathematical expressions. 





20.2.1 Optional Extension: Encoders in Real-Time 


You can also read the robot’s wheel positions real-time from the /encoders ROS topic and use this to plot the 
robot’s motion real-time as it moves through the exercise...or even to correct for motion errors to bring it 
back closer to the desired path! 


Exercise 20.5 


Modify the driveforward.m function to use encoder feedback instead of time to determine when to 
stop the robot. 


Exercise 20.6 


Try writing a function that commands the NEATO to drive a square with the side length as an input 
variable. Think about using the encoder feedback to determine when to turn, and whether the robot 
has turned go degrees. The /cmd_vel’ Ros topic might be a good option here because it takes the 
linear and angular velocity as inputs. If the square is too easy, how about driving a star? 


Exercise 20.7 


Feedback from the encoders can be used to correct the robot’s position if it strays from the planned 
trajectory. Think about how you could calculate error between the anticipated and actual path, and 
what actions would need to be taken to reduce that error. 





20.3 Crossing the Bridge of Doom- Robot Code and Mapping 


The second half of the Bridge of Doom challenge, available in Chapter 21, is to write a piece of software to 
drive a robot across the bridge. While the robot is completing its perilous journey, you will collect encoder 
data, which will be used to reconstruct the robot’s actual path. We will take a few minutes at the end of class 
to discuss your robot code and some recommendations for how to approach the problem. 
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Solution 20.2 


1. Does the plot of the wheel linear travel look as you would expect? Example plot below for the 
case of V; = —0.3 and Ve = —0.3 initially. 


Linear Travel 
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Figure 20.1: Linear travel of left and right wheel while spinning in circles around center. 


2. Find the left and right wheel velocity at each time step and plot them. Do they match your 
expectations? Example plot below for the case of Vr = —0.3 and Ve = —0.3 initially. 
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Figure 20.2: Velocity of left and right wheel while spinning in circles around center. 


195 


CHAPTER 20. ROBO WEEK 3B: MEASURED PATHS 196 


Solution 20.3 


1. Does the linear distance traveled collected by the encoders match the distance input to the 
function? How about the distance travelled by the robot in the simulated world? 


See below. 


2. If the values do not match, why not? 


The linear travel outputted from the encoders is a close match to the input distance to the 
function. The encoder distance measured is based off of wheel revolutions, so the fact the 
robot is slipping on ice doesn’t impact this measurement. However, the slippage will impact 
the actual distance travelled. If we think back to the free body diagrams for rolling objects like 
cars and robots in the Boats module, we’ll remember that the friction force (specifically static 
friction between the tires and the ground) moves the car or robot forward. This same principle 
applies to our Neato robots. To move, the motors apply a torque to the wheels and the friction 
that acts on the wheels as a result will move robot forward. If the torque from the motor is 
greater than the resultant torque from the friction force around the center of the wheel, then 
the wheel will slip. This generally occurs at higher velocities, as the wheels accelerate. For 
low velocities, there is minimal slip between the wheels and the ice rink surface, and the robot 
travels approximately the distance expected (possibly with some sliding at the end). For higher 
velocities, the wheels slip, and the distance travelled will be less than expected. 


3. Plot the linear and angular velocity as a function of time. Do they match your expectations? 


Linear and angular velocity calculated from the encoders will closely match expectations. The 
linear and angular velocity of the actual body are different, but, in a real robot, without a 
position sensor like a GPS or Vicon, you won’t know this from encoder data alone! Hopefully, 
this illustrates the perils of even a simple model like reconstructing position from wheel 
encoders. 


Chapter 21 


Robo: Bridge of Doom Challenge 
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21.1 Overview 
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21.1 Overview 


Welcome to Robo Ninja Warrior. Your first challenge, should you choose to accept it (and you should!), will be 
crossing the Bridge of Doom. This challenge will push you and your robot literally to the brink, requiring you 
to be at the height of your analytical powers. Along the way you'll be building your knowledge of parametric 
curves, deriving robot motion models, and learning powerful validation and debugging techniques. 







asiwep UIeEHeD 


The Bridge of Doom. 
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? Learning Objectives 


By the end of this challenge, you should be able to: 


1. Compute tangent vectors and normal vectors to parametric curves, and connect these vectors 
to motion. 


2. Derive a motion model of a robot. 
3. Validate a motion model of a robot empirically. 
4. Control a robot using an open-loop control strategy. 


5. Map the path of a robot based on encoder values. 


21.2 The Challenge 


You will write a program to autonomously pilot your robot from the starting platform to the goal. What lies 
between? Ahh, that is the harrowing Bridge of Doom. The shape of the centerline of the Bridge of Doom is 
defined by the following parametric curve: 


r(u) = 4{0.3960 cos(2.65(u + 1.4))i — 0.99 sin(u + 1.4)j]. (u € [0, 3.2]) 


21.3 (Re)Meet your Neato 


You've already achieved passing familiarity with your Neato, however, in this challenge you two will really 
get acquainted! The Neato moves via differential drive, which we worked with in class this week. In this 
challenge you are tasked with piloting your robot across the Bridge of Doom. In order to control your robot, 
you will be using open-loop control. Open-loop control means that you will determine a sequence of motor 
commands (e.g., the velocities for each of the Neato’s wheels) ahead of time. You will then write a program 
that sends these motor commands to the robot at the prescribed times irrespective of where the robot is 
along the path. Despite its simplicity, open-loop control can be quite powerful, and it is up to the task of 
crossing the Bridge of Doom. That being said, if you are looking for ways to take this challenge to the next 
level, you can use sensor feedback to modify your path midstream. 


For this challenge, we are considering the maximum wheel speed of the simulated NEATO to 
be 2.0 m/s. Your commanded wheel speeds should not exceed this value. The wheelbase for the 
simulated NEATO is d=0.235m. 
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Figure 21.1: The fearless (simulated) NEATO traversing the treacherous Bridge of Doom. 


21.4 Crossing the Bridge of Doom 


We've already come a long way towards completing our challenge. We have developed equations for V;, and 
Vr that achieve a desired linear and angular velocity, and we have validated this model empirically. All that 
remains is to program our robot to follow a parametric curve! We'll go step by step as follows: 


Exercise 21.1 
. For the Bridge of Doom, plot the parametric curve that defines the centerline of the bridge. 


. On the same figure, plot the unit tangent and unit normal vectors at several points along the 
curve. You should have starter code to help with this in the Robo Homework 1 assignment. 


Exercise 21.2 


. Given the parametric curve, compute and plot your robot’s planned linear speed and angular 
velocity at its COM as a function of time for the Bridge of Doom. 


. After successfully traversing the bridge (i.e. come back to this part later), use your encoder 
data measurements to compute the linear speed and angular velocity of your robot and 
add this to your plot (Note: The wheelbase for the simulated NEATO is d=0.235m). The 
planned (theoretical) speed and angular velocity should be plotted with a solid line, while 
the experimental result should be plotted with a dashed line. Make sure your plots include 
appropriate units, labels, and legends. 


Exercise 21.3 


. Compute and plot your robot’s left and right wheel velocities as a function of time for the 
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Bridge of Doom. 


. After successfully traversing the bridge (again, come back to this), use your encoder data to 
compute the measured wheel velocities and add them to your plot. The planned (theoretical) 
velocities should be plotted with a solid line, while the experimental result should be plotted 
with a dashed line. Make sure your plots include appropriate units, labels, and legends. Do the 
theoretical and measured values match? 


Exercise 21.4 


Write a program to drive your robot across the Bridge of Doom. To do this, you will need to send the 
appropriate control signal to your robot’s wheels based on the time elapsed since the start of the 
path. You can choose to command the left and right wheel velocities directly, or the robot’s linear 
and angular velocity. Both are available through ROS commands. Take a video of your robot 
crossing the Bridge of Doom. 


Note: Be careful about handling the case when |r’(t)| = 0. In this case N(t) is not defined and 
w(t) = 0. You can always slow down or speed up your robot by multiplying ¢ by a constant (we have 
used the constants a or / in previous assignments for this purpose). Be careful since the maximum 
speed of each of the robot’s wheels is 2.0 m/s. 


To get you started: 


1. Start the Bridge of Doom environment in the simulator, use the following MATLAB command. 
>> qeasim start bod_volcano 


2. Download the starter code here. The link will take you to the Robo Ninja Warrior webpage 
where you can click the “Download Source” link. 


3. You will be modifying and running your code in the browser version of Matlab. After down- 
loading the started code to you local machine, navigate to the “Downloads” folder in the 
browser version of Matlab to open the starter code. 


Navigate to the “hosthome->Downloads” directory 


MATLAB R2020a - academic use 


OME PLOTS 


ch oy &q BFndries ee ES D  wrunsection & 


i) Compare ~ «pj GoTo 
NowoReniene ne cae al Run Runand [advance Run and 
. ~ See 7 vance Time 


BREAKPOINTS: RUN. 





t/hosthome/Downloads/starterCodeF orBridgeOfDoomQEA2021.m GE Workspace 
erCodeForBridgeOfDoomQEA2021.m x | + Name © 
function starterCodeForBridgeOfDoomQEA2021 () IF 

% Insert any setup code you want to run here 








% u will be our parameter 
syms u; 


this is the equation of the bridge 
R = 4*[0.396*cos(2.65*(u+1.4));... 
+0.99%sin(utl.4);... 

ol; 


% tangent vector 


T = diff (R); 


% normalized tangent vector 
That = T/norm(T); 














pub = rospublisher(!raw_vel'); { 








SPM ou are currently running MATLAB as root. Best pra in MATLAB only as root when elevated privileges are specifically req 
>> open starterCodeForBridgeOfDoomQeA2021 () 


Select a file to view details 


Open the starter code. It will then be in your 
editor. Save within the “hosthome’”’ directory. 








UIF-S col 1 _| 





4. It is crucial that you save your code within the “hosthome” file tree when working in the 
browser version of Matlab. If you do not, you will lose your work when the broswer is closed. 
The starter code is a MATLAB function; make sure that you save it with a ‘.m’ file extension. 
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5. The starter code will initialize the position of the simulated NEATO on the Bridge of Doom. 
You can build the rest of your robot control program from this starting point. 


. In the browser version of MATLAB, ensure the file is in your path (or folder). At the command 
window, type starterCodeForBridgeOfDoomQEA2021() to run the function. 


. To be successful in the simulated NEATO, you may need to base calculations involving time 
on ‘simulation time’. The solution to Exercise 18.3, on page 171 has critical information for 
using ROS time (we recommend you use rostic and rostoc). 


Exercise 21.5 


Map your robot’s predicted and actual path crossing the Bridge of Doom by using en- 
coder_dataset_collector to capture encoder values as your robot traverses the bridge, convert that to 
coordinates and headings for the robot throughout its perilous journey (if you need a refresher on 
how to use the dataset collector, refer back to Section 20.1). Use the Matlab quiver command to 
plot the predicted and experimental unit tangent vectors at various points along the curve (note: do 
not include an arrow for every time step or your plot will be too cluttered). The planned (theoretical) 
path should be plotted with a solid line, while the experimental result should be plotted with a dashed 
line. Make sure your plots include appropriate units, labels, and legends. 





21.5 Writing up Your Work 


Exercise 21.6 


Prepare a writeup of your work on this challenge. Your writeup should contain the following 
components. 


1. A brief introduction explaining the challenge and including the functional definition of the 


bridge. 


2. A description of your methodology explicitly identifying and explaining the key equations 
and parameters needed to produce the plots identified above. 


3. Each of the plots detailed above with appropriate captions. 


4. A link to a youtube video of your robot in action (include a link in your writeup). Bonus points 
(not really) for high production value like this. 


In addition to the writeup, you should also turn in your carefully commented code (you could add a 
link to a Github repo in your writeup, or upload your MATLAB code files to your Canvas submission). 
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21.6 Optional Extensions 


Exercise 21.7 


1. One weakness of the approach that you implemented is that it doesn’t take into account the 
fact that the robot doesn’t instantaneously do what you tell it to do. One possible way to 
remedy this is to monitor the robot’s position over time using live readings of the wheel 
encoders. In class you derived a method for updating the robot’s position and orientation 
given measurements of its wheel velocities. We call this estimate of the robot’s position its 
odometry. By comparing the robot’s position as determined by its odometry with the desired 
position (given by r(t)) you can try to correct your robot’s motion to more faithfully follow 
the path. How you accomplish this exactly is up to your own creativity and analysis skills. 


. If you’d like, you can traverse the Icy Bridge of Doom. Change the NEATO_WORLD from 
bod_volcano to bod_ice_bridge. In order to navigate this, you will likely need to use the actual 
position as feedback to modify your control strategy. The actual position of your Neato is 
given by the simulator. For an example of how to do this see the motion model experiment 
code from earlier in the module (basically e-mail us if you want to do this!). 





Chapter 22 


Week ga: Bridge of Doom Work Day 


A good time to work on Bridge of Doom and get all the help you need! 


Chapter 23 


Week 4b: Debrief, Partial Derivatives 





Schedule 
23.1 Debrief on the Bridge of Doom .. 1... 0... 2. ee ee ee 201 
23.2 Conceptual Exercise: The Leisure Seeker ............ 0.0000 eee eee 204 





23.1 Debrief on the Bridge of Doom 


To get the most of the bridge of doom challenge, we want you to complete a reflection exercise where you 
create a cheat-sheet with your breakout room. There is a blank cheat-sheet a few pages below that you will 
fill in with your group; the left column depicts the major tasks you needed to complete for the challenge, 
while the other columns have whitespace where you can list equations, matlab functions, and other notes 
you found useful during the challenge. Make sure to talk with your group; they may have discovered some 
useful things you'd like to learn about! 


Exercise 23.1 


1. Which parts of the BOD challenge were confusing? Are there any math or MATLAB tools you 
can write down to help avoid that confusion in the future? 


. Were any of the MATLAB functions you used surprising? Can you write yourself some notes 
to avoid being surprised in the future? 


. Were there any expressions / functions that were useful? Can you write yourself some notes 
to make sure you can rediscover these useful tools in the future? As an example, I partially 
filled a sheet (Fig. 23.1) You should go much further than this, though! 
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Figure 23.1: Examples of things you might put in your reflection sheet. 
The empty cheat-sheet is on the next page. 
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23.2 Conceptual Exercise: The Leisure Seeker 


The map below gives the temperature across the United States on a certain winter day. Regions of the same 
color have the same temperature: violet represents the coldest areas, and temperatures rise as the colors 
traverse the spectrum from indigo to blue to green to yellow to orange to red. 


Exercise 23.2 


Locate Chicago on the map and mark it with a dot. The weather in Chicago is freezing in winter, so 
a resident of the city decides to embark on a journey in search of the sun. From Chicago, she wants 
to travel in the direction in which the temperature rises most quickly. As her journey proceeds, she 
decides to keep traveling in the direction in which the weather warms up most quickly: wherever 
she is at any moment, she moves in the direction of fastest temperature rise. 


1. Make a rough sketch of the route she takes. 
2. Where does she end up, assuming that she doesn’t leave the United States? 


3. What would happen if her friend started in Billings, Montana? Where would he end up? 
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Solution 23.1 


1. Which parts of the BOD challenge were confusing? Are there any math or MATLAB tools you 
can write down to help avoid that confusion in the future? Answers will vary. 


2. Were any of the MATLAB functions you used surprising? Can you write yourself some notes 
to avoid being surprised in the future? Answers will vary. 


3. Were there any expressions / functions that were useful? Can you write yourself some notes 
to make sure you can rediscover these useful tools in the future? Answers will vary. As an 
example, I partially filled a sheet (Fig. 23.1) You should go much further than this, though! 
There are many ways to tackle this one! 


Solution 23.2 


1. See Fig. 1. 


ace Temperature (F) 





2. Near Panama City, FL 


3. Hard to know exactly without more isotherms (contours of constant temperature), but maybe 
the SF Bay Area or the Portland area. 


Chapter 24 


Homework 4: Partial Derivatives, 
Chain Rule, Max and Min 


? Learning Objectives 

Concepts 
+ Compute partial derivatives using the chain rule and product rules for differentiation. 
« Determine critical points of a continuous function of single variable. 
+ Use the gradient function to compute critical points of multivariate functions. 


« Evaluate whether critical points of a multivariate function are local maxima, minima or 
otherwise. 


24.1 Partial Derivatives and the Chain Rule 


We met partial derivatives earlier, and we are now going to return to this idea to reinforce it and to extend 
it. Work your way through sections 14.3 and 14.5 from the book Multivariable Calculus by 
Stewart—we've included section 14.6 for completeness, but we will discuss that chapter in a future 
assignment. 


Exercise 24.1 


1. Please read Section 14.3 from Stewart on Partial Derivatives. Take notes on important concepts 
and definitions. 


. Please read Section 14.5 from Stewart on The Chain Rule. Take notes on important concepts 
and definitions. 


This is new material on extending the notion of the chain rule from functions of one variable 
to functions of many variables. The main results are captured in the pink boxes labeled 1 
through 4 - these are various cases of the chain rule. Again, this text is written for a student 
who doesn’t have linear algebra. As you read these rules, think about how you might use 
matrix notation to make this cleaner and more compact. At this stage you should ignore the 
section on Implicit Derivatives - it will be too confusing and take too long. 


Do the following exercises (by hand or using a Computer Algebra System) 





209 


CHAPTER 24. HOMEWORK 4: PARTIAL DERIVATIVES, CHAIN RULE, MAX AND MIN 210 


3. Complete question 1 from 14.5 Exercises. 


4. Complete question 5 from 14.5 Exercises. 


5. Complete question 11 from 14.5 Exercises. 


CO) 


24.2 Max and Min of Single Variable Functions 





In high school you probably spent a good amount of time thinking about the relative maximum or relative 
minimum of a function of one variable. You’ve probably met the following idea before: 


x = aisacritical point of f(x) if f’(a) = 0. 


This simply means that a critical point is a point where the derivative is zero. 


Exercise 24.2 


Find the critical point(s) of f(a) = 2* — x” + 1 (can be done by hand or computer algebra system). 





CO) 


Once we have the critical points, there is a straightforward test to determine whether any critical point 
is a relative maximum or relative minimum. 


The critical point x = ais a relative minimum if f”(a) > 0. The critical point x = a isa relative 
maximum if f(a) < 0. 


This means that in order for a point to be a relative minimum, the first derivative must be zero and the 
second derivative must be positive, and vice versa for a relative maximum. If both the first and second 
derivatives are zero then no conclusion can be drawn without further investigation. 


Exercise 24.3 


Classify the critical point(s) of f(z) = «4 — 2? +1. 





CO) 


If you would like to review this material or have more practice please check out the following sections 
from Paul’s Online Math Notes: 


¢ Critical Points 


¢ Minimum and Maximum Values 


24.3 Max and Min of Multivariable Functions 


Let’s examine the corresponding idea for functions of two variables. 


(x,y) = (a,b) is a critical point of f(x, y) if V f(a, b) = 0. Recall that the gradient vector is 
composed of the first-partial derivatives, Vf = [fz fy]. 


This means that in order for a point (a, b) to be a critical point in two dimensions then both partial derivatives 
need to be zero there. 
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Exercise 24.4 


Determine the critical points of the following functions (can be done by hand or using a Computer 
Algebra System.) 


1. f(z,y) =4+a° +y? — 3ay 
2. f(x,y) = 3a7y + y® — 3a? — 3y2 +2 


——) 


Once we have the critical points, there is another straightforward test to classify the type of critical 
point. However, when we have more than a single variable, the critical points can be something other than a 
simple maximum or minimum. This is illustrated in figure below of the f(x,y) = «2? — y”. At the critical 
point, (0,0), Vf = 0. As you look at (0,0) does it appear to you as a maximum or a minimum point? To 
see what is unusual about (0, 0), imagine you were to take a cut of the yz-plane at x = 0. What would you 
see? Then take a cut of the xz-plane at y = 0; what would you see in this case? 


























Figure 24.1: The plot of a saddle function. Generated with CalcPlot3D. 


The following approach to characterizing critical points is not usually discussed in a multi-variable 
calculus course because students are not expected to know linear algebra. 


Suppose (a, b) is a critical point of f(x,y). The Hessian matrix H f evaluated at the critical 
point has real eigenvalues 1 and 2 (Recall that a symmetric matrix has real eigenvalues). Then 
the following classifications are possible: 

1. If Ay < Oand Ag < 0, then the critical point is a relative maximum. 

2. If Ay > Oand Az > 0, then the critical point is a relative minimum. 

3. If Ai > Oand Az < 0OR Ag > Oand A; < 0, then the critical point is a saddle. 

4. If Ay = 0 or Ap = 0 (or both equal zero) at the critical point then no conclusions can be 


drawn without further investigation. 


So we see that for a function of two variables that there is a new type of critical point, the saddle - it is a 
relative maximum in one direction, and a relative minimum in another. 


CHAPTER 24. HOMEWORK 4: PARTIAL DERIVATIVES, CHAIN RULE, MAX AND MIN 212 


Exercise 24.5 


Classify the critical points of the following functions 


1, f(t, yy—4 +a? +y? — Bay 


2. f(z, y) = 327y + y® — 3x? — 3y2 +2 
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Solution 24.1 


+ Complete question 1 from 14.5 Exercises. Notice that z is a function of two variables, x and y; 


x and y vary with t, so to compute the ee we need to sum portions of 


dz 


a due to x and the 


portion due to y. 





+ Complete question 5 from 14.5 Exercises. Notice that w is a function of three variables (x, y 
and z), each varying with t, so to compute the te we need to sum that parts of the total te 
due to the partial contributions (2) of x, y and z. 


er 


p one w 


ws xe’? 





dw, ow 

a az 
aaa 

4 


+ Complete question 11 from 14.5 Exercises. Notice that z is a function of two variables (r and 
0), each varying with s and t. To compute gz for example, we need to sum portions of oe due 
to the variation with Os in each of r and @. In this case, 92 are partial derivatives, since the 


Os 
total dz consists of Os and Ot. 
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: oe d= 


Z2=ecoe rest, eels 

2/ Xe =: Rit ed 
oe an Gases d2_ Qe dC, oe 28 
a/R 8/7 Fee We Tee 
5 esagpet 


BE 2 2 Ce eose) ze (st) + 3% (econo) % (cs 44*)) 


Constants under lined 


= <os 6 et 


As = eC" (tcoso a RE 
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oe 
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Solution 24.2 


= ») “ r) \o ’ 
DE = ar (© cose) (st) + (eves) ((s*+t)4) 


+ e'(-smoy 4) (see) “(280 


% ef sim0)(4) (74°) ~ (2) 


We first take the derivative so that f’(2) = 4a — 2z and then we set it equal to zero so that 
4a? — 2a = 0 and then we solve for x. Since x is a common factor we see that the solutions are 


dictated by x = 0 and 4x? — 2 = Ooraz =4 





Solution 24.3 


+/2 /2. This function therefore has three critical points. 


We've already found the critical points. Let’s now determine the second-derivative, and evaluate it at 
each of the critical points. The second derivative is f’’(~) = 12”? — 2 and evaluating at each of the 


critical points gives: 


(0) = -2 
f(£v2/2) = 4 





The critical point at x = 0 is therefore a relative maximum, while the critical points at +/2/2 are 


both relative minima. Graphing the function would confirm this very quickly. 





214 


CHAPTER 24. HOMEWORK 4: PARTIAL DERIVATIVES, CHAIN RULE, MAX AND MIN 


Solution 24.4 


1. We already met this function in Robo Night 2 and computed its partial derivatives then. The 
gradient vector is: 
3a? — 3y 
LS ie - =| 


We now determine the values of x and y for which both derivatives are zero simultaneously. 
Setting the first component to zero leads to y = x? which we can substitute into the second 
component and set it equal to zero to obtain «* — x = 0. The solutions are therefore x = 0 
and x = 1 which leads to the points (0,0) and (1, 1). 


2. We’ve already met this function in Robo Night 2 and computed its partial derivatives then. 
The gradient vector is: 
- 6xy — 6x 
Vie se + 3y? — a 


We now determine the values of x and y for which both derivatives are zero simultaneously. 
Setting the first component to zero leads to x = 0 or y = 1 which we can substitute into the 
second component and set it equal to zero to obtain two possibilities: « = 0 AND 3y? —6y = 0 
OR y = 1 AND 3x? — 3 = 0. The first possibility has y = 0 ad y = 2 as solutions, while the 
second possibility has 2 = +1 as solutions. There are therefore 4 solutions: (0, 0),(0, 2),(1, 1), 
and (—1, 1). 





Solution 24.5 


1. We already know the critical points are (0,0) and (1,1). We need to compute the Hessian 
matrix to classify it. Fortunately, we already computed the second-derivatives in Robo Night 2 


so that 
6x —3 
le ie a 
+ At (0,0) we see that 
0 -8 
a= 0) 
which has eigenvalues 43 = —3 and Ag = 3 so that this critical point is therefore a 
saddle. 
« At (1,1) we see that 
6 —-83 
mal 
which has eigenvalues \,; = 9 and Ay = 3 which implies that this point is a relative 


minimum. 


2. We already know the critical points are (0, 0),(0, 2),(1, 1), and (—1, 1) We need to compute 
the Hessian matrix to classify it. Fortunately, we already computed the second-derivatives in 
Robo Night 2 so that 


_ |6y-6 62 
ne | 6c Gy — i 
+ At (0,0) we see that 
-6 O 
malo “4 
which has eigenvalues 4; = —6 and Az = —6 which implies that this point is a relative 


maximum. 
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« At (0,2) we see that 


which has eigenvalues A, = 6 and Az = 6 which implies that (0, 2) is a relative minimum. 


« At (1,1) we see that 


mal g 


mal g 


which has eigenvalues \; = —6 and Az = 6, which implies that this point is a saddle. 


« At (—1, 1) we see that 


ar=|" 9 


which has eigenvalues \; = —6 and Az = 6, so that this point is also a saddle. 
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Chapter 25 


Robo Week 5: Gradient Ascent and 
The Flatland Challenge 


Schedule 





25.1 Mini-Lecture: The Gradient ............ 0.2 eee eee ee te eee 
25.2 The Leisure-Seeker .......... 0 cee eee ee tee te tt ee 
25.3 Conceptual Questions about Partials and Gradients .................. 
a .4 Gradient Ascent... vv080606 6s ee RES ERT EET EEA BW Sw eG 
25.5 Gradient Ascentin MATLAB ........... 0... e eee cence een n eens 
25.6 Flatland Challenge . <...050 0405-4 4d 4648 $8 HS HER EGE ee ee ee 





25.1 Mini-Lecture: The Gradient 


* Contours of a function are curves of constant function value, f(r) = c. 
+ We can use the chain rule to prove that 


- the gradient is orthogonal to the contours of a function f(r). 


- the gradient points in the direction of steepest ascent for a given function f(r). 
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25.2 The Leisure-Seeker 


Surface Temperatur 


© UNISYS 
HI: 





Figure 25.1: This trajectory is an example of the techie’s gambit—making an unconsidered beeline for Silicon 
Valley. Can you explain why this is an incorrect example of gradient ascent? 


Exercise 25.1 


1. Figure 25.1 depicts regions of relatively similar temperature values; the boundaries between 
these colored regions are contours. Draw in a few gradient vectors along contours in the 
Pacific Northwest region of the map (near Washington, Oregon, and northern California). 


. Figure 25.1 is an example of an incorrect trajectory for gradient ascent. There’s a very obvious 
reason why this trajectory is incorrect—what is it? 


. Draw an updated version of the curve, starting from northern Idaho and following the gradient 
of the temperature field. 
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25.3 Conceptual Questions about Partials and Gradients 


Exercise 25.2 
. What is meant by f,,? By ae, By Duf? By Vf? 


. The idea of gradient is often discussed primarily in two dimensional and three dimensional 
“physical” spaces, using i, j, and so forth. But more generally, you can have a gradient of a 
function of any number of variables. Give a real-world example of a gradient for a situation 
that involves more than 3 variables. 


. “The gradient always points in the direction of fastest increase.” Can you think of physical 
examples where there is more than one direction of fastest increase? What’s going on here? 


. “The gradient is always normal to level curves/surfaces.’ Explain. Note: In this context, "level 
curves/surfaces" is referring to contour lines on a surface. Each contour line indicates a 
particular value or ‘level’ of the scalar function. 


. “The directional derivative in the direction of u is given by V f -t” Why does this make sense? 


. If the gradient is zero, does that imply that you are at a max or a min? Why or why not? 


: of arf 
. What does it mean for gz > 0? What about aon 0? 


Exercise 25.3 


The diagram below shows a contour plot for a function. Sketch in the gradient field. 
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Exercise 25.4 


The diagrams below show two vector fields. One is the gradient of a function of two variables; the 
other is not. Which one could be a gradient? Why? Sketch in the level curves for the one that works. 
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Exercise 25.5 
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The diagram below shows some level curves of a function g(x, y). The numbers indicate the g-values 
of these level curves, and the letters indicate points on the level curves. Note that point Y is on the 
level curve g = 1 and point W is on the level curve g = —2. 


y 


a 








1. What are the signs of the partial derivatives go and Seat each of the points marked 
(R,S,T,U,V,W,X and Y)? 


2. At which of the points marked does the gradient vector Vg have the greatest magnitude? 


Explain. 
__ |i 
le 


The directional derivative Dag is zero at exactly one of the points marked. Which point is it? 


3. Let 





25.4 Gradient Ascent 


Gradient Ascent (or descent) is a technique to determine the maximum or minimum of a function of many 
variables by taking steps in the direction of the gradient (or negative gradient). If the height of a surface is 
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described by z = f(r), where r is the position vector in the plane, and we begin at ro, the points determined 
by Gradient Ascent are given by 


Yaoi =T + AVF (Ti); t= 0, 1,2, aoa 


where 4, is the relative size of the step that we take in the direction of the gradient. (Incidentally, this \ has 
nothing to do with eigenvalues; we’ve just run out of Greek letters!) There are various schemes for choosing 
these, and one of the simplest is to determine the next step with a simple proportionality 


M41 = OX 


where 0 < 6 < 1. To choose Ag and 6, we have to consider the particulars of the problem. For example, if 
5 = 1, the simplest scenario, we increment each step by \. The choice of 4 depends on how the surface 
changes. We are going to develop a method and implementation to drive your NEATO on the floor of the 
classroom in a way that physically realizes the method of Steepest Ascent. First, we are going to introduce 
the mountain you will climb, and you will think through the steps involved. 


Exercise 25.6 


The mountain you will "climb" is defined as follows 








f(t,y) = ay — 2? -y? 2y +4 


where «x, y, and f are measured in meters. You are required to start at (1, —1), and work your way 
to the top by method of steepest ascent. 


1. Visualize the contours of this function on the domain (—3, 1) x (—3, 1). This notation means 
the set of points that have an x and y components, —3 < x,y < 1. 


. Draw the path of steepest ascent if we were moving continuously from a starting point at 


(1,-1). 
. Find the gradient of this function. 


. Assuming ro = (1, —1), what is the initial gradient at ro? What would be a reasonable choice 
for Xo so that rj is not too far from the continuous path? Plot r; on your contour plot. 


. Assuming you place your NEATO at (1, —1) pointing along the y-axis, how much do you have 
to rotate it in order to align it with the gradient at ro? What would be a reasonable angular 
speed? 


. Assuming that you are going to drive your NEATO at 0.1m/s, how long would you drive in 
order to reach r,? 


. What is the gradient at r;? What value of 6 should you use so that A, and r2 are reasonable? 
Plot rz on your contour plot. 


. Assuming your NEATO is now at r1, how much do you have to rotate it in order to align it 
with the new gradient? What would be a reasonable angular speed? 


. Assuming that you are going to drive your NEATO at 0.1m/s, how long would you drive in 
order to reach ro? 
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25.5 Gradient Ascent in MATLAB 


In this exercise we would like you to implement gradient ascent in MATLAB. Recall that if f(r) is a scalar 
function of a position vector r, the points determined by gradient ascent are given by 


Poi =1 +A VO), t= 1... 


where 4, is the relative size of the step that we take in the direction of the gradient. There are various 
schemes for choosing these—one of the simplest is a proportionality rule that modifies the scaling factor ); 
at each step 


Ait = 6X4 
where both 6 and Xo are thoughtfully chosen for the problem at hand. 


Exercise 25.7 


. Remind me; what must be true about the gradient at a maximum of a function? What does 
that tell you about the norm (length) of the gradient at that point? 


. Develop pseudo-code for the gradient ascent algorithm. Keep it general: Assume that you 
have f, a general scalar function of a vector r. Suppose you have a MATLAB function that 
provides the function value fun(r) and gradient grad(1r). You are going to want to use a 
loop - a "while" loop would be a good choice. Introduce any parameters you need to make this 
pseudo-code work, and make sure to return the entire history of points r;. What would be a 
reasonable stopping criterion? 


. When you are happy with your pseudo-code, develop a script or function that: 


(a) Automatically determines the discrete points r1, ro, ..., rp given an initial point ro. 
(b) Can be tuned by varying 6 and Xp. 
(c) Takes any other parameters that you deemed necessary in writing your pseudo-code. 
(d) Returns the entire history of tested points r;. 
. Test your gradient ascent algorithm on the function f(x, y) = xy — a? — y? — 2x — 2y + 4. To 
start, use the parameter values rp = [0.7, 0.5], Ao = 0.9, 6 = 0.9. Does your algorithm reach 
the maximum of the function? How do you know? 





. Visualize the sequence of points r; for i = 1,...,n returned from your algorithm in the 
previous part. Do the points travel “directly” to their endpoint? Or do they “wander”? 


. Test your gradient ascent algorithm on the function f(x,y) = ry — 2? — y? — 2a — 2y +4. 


To start, use the same parameter values as before, but set 6 = 1.1. Does your algorithm reach 
the maximum of the function? If not, what went wrong? 








Pseudo-code for exercise above. 


Provide: grad, delta, lambda0O, tolerance, n_max, r_0 
Set: n=0, r_i = r_0O, grad_i = grad(r_i), lambda = lambda_0, R = [r_0] 
While: n < n_max and norm(grad_i) > tolerance do 

r_i = r_i + lambda * grad_i 

R(end + 1) = r_i 
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grad_i = grad(r_i) 
lambda = delta * lambda 
n=n+4+1 

Return: R 


25.6 Flatland Challenge 


You will develop a method and implementation to drive your NEATO on the (virtual) floor of the classroom 
in a way that physically realizes the method of Steepest Ascent. The mountain you will "climb" is defined as 
follows: 


z=f(z,y) = ay —2? —y? — 22 —-2y+4 





where x, y, and z are measured in meters. You are required to start your NEATO at (1, —1) pointing in the +y 
direction, and work your way to the top. In order to position your NEATO with the correct orientation, you 
can use the placeNeato. m function, which we have provided (Note: that the placeNeato function is 
already inside of the simulated environment, you do not need to download it in order to use it). 


Exercise 25.8 


1. Decompose this problem. What are the steps involved? You should have a decomposition that 
clearly explains the process of driving the NEATO along a discrete approximation to the path 
of steepest ascent. 


. Now develop the code for the NEATO. It may help to review your Bridge of Doom code.... 


. Now drive your NEATO! You will startup the Neato simulator using the f lat Land envi- 
ronment. Remember, full instructions for using the simulator are available on the Meeto 
Your Neato page. For this challenge you'll want to run the flatland world using qeasim. In 
MATLAB, run this command. >> qeasim start flatland_no_spawn 
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Solution 25.1 


1. Figure 25.1 depicts regions of relatively similar temperature values; the boundaries between 
these colored regions are contours. Draw in a few gradient vectors along contours in the 
Pacific Northwest region of the map (near Washington, Oregon, and northern California). 


ace Temperature (F) 





Remember that the gradient lies orthogonal to contours. 


2. Figure 25.1 is an example of an incorrect trajectory for gradient ascent. There’s a very obvious 
reason why this trajectory is incorrect—what is it? In its middle, the trajectory runs parallel 
to a contour line. Remember that the gradient lies orthogonal to contours. In order for this 
trajectory to be a gradient ascent, it must be orthogonal to contours of the map. 


3. Draw an updated version of the curve, starting from northern Idaho and following the gradient 
of the temperature field. 
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This curve is correct because it lies orthogonal to every contour it crosses. 


Solution 25.2 


1. The partial derivative with respect to 7, meaning the slope in the « direction (where every 
other independent variable is held constant); the second partial derivative with respect to x, 
meaning the curvature in the x direction (where every other independent variable is held 
constant); the directional derivative with respect to vector u, meaning the slope in the u 
direction; the gradient, meaning the maximum slope in its corresponding direction. 


2. For example, the temperature depends on three spatial variables and time, i.e. T(x,y,z,t). The 
gradient would tell you in which direction (including time!) to move so as to increase the 
temperature the fastest. 


3. At the bottom of a cone, the increase is equally fast in all directions. 


4. The gradient points in the direction of most rapid increase—this direction must be perpendicular 
to the level curves of the function since the function is unchanged on a level curve. 


5. The gradient could be decomposed into a component in t direction and a component normal 
to that. Here, tis an arbitrary direction that we are choosing. So the rate of change of the 
function in the U direction is Vf - 0. 


6. No, because you could be at a saddle point, for example. 


7. Upward curvature in the x-direction; slope in y-direction increases with increasing x (and vice 
versa). 
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Solution 25.3 


NS. y JF Fs 
persis eae, 
~~ 2788; —+—— 





Solution 25.4 


The one on the left could be a gradient; the right one could not because a path of gradient ascent 
would go in a circle. That is a problem because any point would have two gradient values associated 
with it—there is no way that it can come from the derivatives of a function. See Fig. 25.3 for a sketchy 
sketch of level curves for the left one. 

















Solution 25.5 
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Point Signofg, Sign of g, 


R -oro + 
S - + 
T - (0) 
1. U (0) = 
Vv + (0) 
WwW - - 
xX (0) 7 
Y + + 


2. At Y because the contours are closest together, indicating the greatest change in the function 
value per unit distance normal to the level curves. 


3. We are looking for a point on a contour line that has a tangent (or equivalently, slope) that is 
=u. At that point, when we take the dot product of u and the gradient (perpendicular to the 
contour line), we will get o. Point S, where the contour line is parallel to u. 


Solution 25.6 








2. See the path on the contour plot. 
3. (-2 — 24+ y,-2+ 4 — 2y) 


4. Initial gradient is (-5,1), with a magnitude of roughly 5.1. To move about 0.5 meters, the initial 
multiplier \9 should be about 0.1 meters. This gives ry = ro + Ao Vf (Lo) = (0.5, —0.9). 


5. We have to rotate from the y-axis to the direction of the gradient (-5,1) - this is roughly 1.37 
rad (78.7 degrees) CCW. 0.5 rad/s would not exceed 0.3 m/s if rotated in place. 


6. The time taken to reach r; is determined by t = rir ae 


our units the same. The distance traveled is roughly 0.26 = 0.5 meters which is roughly 
0.15 m. At a speed of 0.1 m/s this would take 1.5 seconds. 








where we remember to keep 


7. The approach to these is similar to the first step. 
8. The approach to these is similar to the first step. 


9. The approach to these is similar to the first step. 
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Solution 25.7 


1. Remind me; what must be true about the gradient at a maximum of a function? What does 
that tell you about the norm (length) of the gradient at that point? The gradient must be zero 
at the maximum of an objective function (in the unconstrained case). Therefore, the norm of 
the gradient is zero at this point. 


2. Develop pseudo-code for the gradient ascent algorithm. Keep it general: Assume that you 
have f, a general scalar function of a vector r. Suppose you have a MATLAB function that 
provides the function value fun(1r) and gradient grad(r). You are going to want to use a 
loop - a "while" loop would be a good choice. Introduce any parameters you need to make 
this pseudo-code work, and make sure to return the entire history of points r;. What would 
be a reasonable stopping criterion? My stopping criterion is a tolerance on the norm of the 
gradient. See below for pseudo-code. 


3. When you are happy with your pseudo-code, develop a script or function that: 


(a) Automatically determines the discrete points rj, r2,..., rn given an initial point ro. 
(b) Can be tuned by varying 6 and Xo. 
(c) Takes any other parameters that you deemed necessary in writing your pseudo-code. 


(d) Returns the entire history of tested points r;. 
Zach prepared a solution available here, as well as an example of its use. 


4. Test your gradient ascent algorithm on the function f(x,y) = ry — x2? — y? — 2a — 2y +4. To 
start, use the parameter values rp = [0.7, 0.5], Ag = 0.9, 6 = 0.9. Does your algorithm reach 
the maximum of the function? How do you know? My code reaches its gradient termination 
criterion, and lies at the center of a high-value contour. This is evidence that the algorithm 
has converged to a local maximum of the function. 


5. Visualize the sequence of points r; for i = 1,...,n returned from your algorithm in the 
previous part. Do the points travel “directly” to their endpoint? Or do they “wander”? With the 
parameters above, my gradient ascent algorithm produces iterations r; that tend to “wander”; 
this is common behavior for gradient ascent. 


6. Test your gradient ascent algorithm on the function f(z, y) = ry — x? — y? — 2% — 2y +4. To 
start, use the same parameter values as before, but set 6 = 1.1. Does your algorithm reach the 
maximum of the function? If not, what went wrong? My code produces an iteration sequence 
that diverges; the gradient does not converge to zero but rather grows very large. 


Solution 25.8 


1. Decompose this problem. What are the steps involved? You should have a decomposition that 
clearly explains the process of driving the NEATO along a discrete approximation to the path 
of steepest ascent. 


2. Now develop the code for the NEATO. It may help to review your Bridge of Doom code.... 


3. Now drive your NEATO! You will startup the Neato simulator using the f lat land envi- 
ronment. Remember, full instructions for using the simulator are available on the Meeto 
Your Neato page. For this challenge you'll want to run the flatland world using qeasim. 
In MATLAB, run this command. >> qeasim start flatland_no_spawn Paul has put 
together a solution file here 
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Robo Week 6: LIDAR and Line Fitting 





Schedule 
26.1 Introductionto LIDAR ...... 0... 2.2... 2 2 eee ee 228 
26.2 Polar and Cartesian Coordinates ............0 0c eee eee eee eee 231 
26.3 Fitting Models to Laser Scan Data... 1.1... ee ee 233 
26.3.1 Linear Regression for Line Fitting «0.00... 000 56 6 6b Re 233 
26.3.2. Principal Component Analysis for Line Fitting .................0-. 237 
26.4 Least-Squares (Optional) .. 2... 1. ee ee ee et ns 239 





? Learning Objectives 

Concepts 
¢ Convert vectors from 2D Cartesian to Polar coordinates (and vice versa). 
- Explain how Linear Regression produces a line of best fit to a 2D dataset. 
« Explain how PCA produces a line of best fit to a 2D dataset. 

MATLAB skills 
- Eliminate o-entries from LIDAR data. 
« Plot LIDAR data on a polar coordinate system. 


+ Generate best-fit lines to LIDAR data using linear regression and principal component analysis. 
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26.1 Introduction to LIDAR 





Figure 26.1: A schematic of the Neato’s laser scanner. Due to the relative position of the emitter and detector, 
the position of the reflected light changes predictably as a function of d. The laser scanner spins with a rate 
of 5Hz. The angle of the scanner is denoted as 0. 


Laser scanners are becoming an increasingly important sensor in modern robotics. A key accelerator 
of this trend is the development of self-driving cars, which use laser scanners as their principal source of 
information about the world around them (e.g., check out this video of a 3D map of a highway in the San 
Francisco Bay Area). 

Your Neato comes with a much more basic laser scanner than the long-range 3D scanners you see in 
self-driving cars. The Neato’s laser scanner provides an estimate of the distance to nearby features in the 
environment (e.g., obstacles) at a rate of 5 Hz, with an angular resolution of 1 degree, and a maximum 
usable range of about 3 meters. Under the hood, the sensor works by emitting a laser and then detecting the 
reflected laser light using a camera. From the known geometry of the camera / laser pair and the position of 
the reflected laser beam in the camera image, the depth of the obstacle can be recovered (see Figure 26.1). 
Further, the entire laser / camera assembly spins, providing an estimate of the distance to features in the 
environment in a full 360-degree sweep around your robot. 
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Figure 26.2: A schematic of the laser scan data. In the figure, rgo indicates the distance in meters to a detected 
object at a bearing of # degrees. msg. Ranges shows how each of these distances maps to a particular index 
in the array. The array holds the distances, and the angles are implicitly encoded by the position in which 
they appear in the array. If no detection is made at a particular bearing, the value 0.0 is used instead. Note: 
the angles of the measurements around 0 = 0° have been exaggerated for visualization purposes (i.e. the 
angles shown are larger than a single degree). 


Sometimes it is useful to take the raw points detected by the laser scanner and interpret them as 
geometrical objects (e.g., lines, curves, polygons). For instance, given the laser scan in Figure 26.3 we may 
wish to automatically interpret the laser scan data (i.e. pick out lines, circles, etc.). 
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Circle 





Figure 26.3: A laser scan with high-level features identified. 


Conveniently, throughout the class we’ve built a lot of the machinery needed to do just this (aren’t we 
sneaky?). Here, you'll have a chance to bring it all together. 
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Figure 26.4: Illustration of vector in polar and Cartesian coordinates. 


26.2 Polar and Cartesian Coordinates 


The output data from many sensors, including LIDAR data, is typically presented in polar coordinates. In 
many situations, however, it is more convenient to represent the data in Cartesian coordinates. In this set of 
exercises, you will get some practice converting polar to Cartesian coordinates and vice-versa. 

In Cartesian coordinates, a point in 2-D space can be described as a sum of unit vectors in the iand j 
directions, which are unit vectors in the directions of the x and y axes respectively. 

Consider the point (4, 3) illustrated in Figure 26.4. You can write the vector representing this point as a 


sum of i and j as follows 
4 ae de 
5 = 41+ 3j (26.1) 


We can also write this point in terms of polar co-ordinates as (r, #), where 


r= /42 + 32 =5 (26.2) 


6 =tan7? (3) (26.3) 


In general a vector (a, y) in Cartesian coordinates can be expressed in polar coordinates as (r, 0) where 
r=Vur2+y? (26.4) 
6=tan! (2) (26.5) 

x 


To go from polar to Cartesian coordinates, we can use the following formulas 


x=rcosé 
y =rsing 


Besides expressing a vector as a linear combination of the i and j vectors, we can also define two new 
unit vectors f and @ defined as follows 


f= ie | (26.6) 


sin 0 


A —sind 
= | cos 6 Peay) 
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Note that these vectors are not absolute with respect to the origin of the cartesian coordinates. While it does 
seem strange to represent unit vectors in this manner, this kind of representation will prove useful in the 
near future when we are dealing with dynamics of rotating bodies (i.e. you will not directly use this until 
next semester, but we thought we should give you a preview). 


Exercise 26.1 


Convert the following from Cartesian to polar coordinates. 
1. (x,y) = (—8,6) 
2. (x,y) = (5, 12) 


Exercise 26.2 


Convert the following from polar to Cartesian coordinates. 
i. (70) = ( 13) 
2am (0) e— (2, —f) 


Exercise 26.3 
What is # - 6? 


Exercise 26.4 


In words, describe the r and 6 vectors. 


Exercise 26.5 


Now let’s look at some LIDAR data that was collected from the Chamber of Emptiness™, which is a 
desolate room with one wall. Load the data in scani.mat, which should contain the variables r for 
range (distance from the scanner in meters) and theta for the angle from the front of the robot (see 
Figure 26.3). 


1. Plot these data using: plot (theta,r,'ks') 


2. Plot the data in polar coordinates using: 
polarplot (deg2rad(theta),r,'ks', 'MarkerSize',6, 'MarkerFaceColor','m') 
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3. You should see two subsets of data (a line and a parabola in the plot from part 1). Where are 
these two subsets represented in the polarplot? 


. When the LIDAR does not detect any object at a given angle, it outputs a o for the value of r 
at that angle (this is a common problem in the Chamber of Emptiness). Create new variables 
theta_clean and r_clean which represent the angles and values of r when r is not zero. 


Note: It may be useful to use the Matlab syntax “~=”, which means “not equal.’ The find () 
function can also be helpful here. 


. Now convert r_clean and theta_clean to Cartesian coordinates and plot them using the 
plot () function. 


Note: A working code snippet to accomplish these tasks is in the solutions. 


CY 


26.3 Fitting Models to Laser Scan Data 





26.3.1 Linear Regression for Line Fitting 


The first structure we would like to detect in the laser scan data is a line. We’ve seen the notion of a line of 
best fit a couple of times in Module 1, so let’s take a moment to review the process of fitting a best fit line to 
a set of data using techniques from linear algebra (often known as linear regression). 

Assuming we have converted our LIDAR measurements to Cartesian coordinates, we can assemble all of 
the x-coordinates in a column vector x and all of the y-coordinates in a column vector y. Let’s now find 
the best-fit straight-line through these points, ie. let’s find the parameters m and b so that the straight-line 
defined by 

y=ma+b (26.8) 


fits the points as well as possible. 
The approach we take is motivated by our work in linear algebra. If we pack all of the x-coordinates into 
a vector x and all of the y-coordinates into a vector y then we would like to satisfy the vector equation 


y=mx+b (26.9) 


as well as we can. Notice that there are many equations here (one for each point) and only two unknown 
parameters, m and b. An exact solution is impossible (unless the points happen to lie on a line) and so we 
use orthogonal projection to find the best solution. Let’s define a matrix A and parameter vector p so that 
the vector equation for a straight-line becomes 


Ap=y (26.10) 
where A and p are given by 
m 
A= [x 1) p= "| 
Notice that there is a coefficient of "1" in front of the "b" term so we had to create a column vector and fill it 
with 1’s. 
Recall that to find the best solution we multiply by A’, 


A’Ap=A’y (26.11) 


and solve this linear system for p. In MATLAB we can simply use the backslash operator as follows (assuming 
we already defined x and y as earlier), since it will return the best fit solution when A has more rows than 
columns: 
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> 
ll 


[x ones(length(x),1)] 
= A\y 


oO 
| 


As we will see later, the linear regression solution is the line that minimizes the sum 
of the vertical distances between the data points and the best-fit line. 


Exercise 26.6 


For each of the laser scans below (the data has been cleaned to remove zero values), please consider, 
qualitatively, what the “best fit line” should look like. To do this, follow these steps: 


1. On your Miro board, each member of the group should draw in their guess of the best fit line. 
It is best to use a line drawing tool, not the free-hand drawing tool. 


2. Each member of the group should explain why they chose the line they did, and how their 
proposed line minimizes the vertical error between the experimental data and the proposed fit. 


3. Once each group member has discussed their fit, compare your qualitative best fit line with 
the linear regression solution. 


(a) How close was your guess to the linear regression solution? 


(b) Was your fit or the algorithmic fit “more accurate”? What metric of accuracy are you 
using when you make this decision? 


(c) For cases where your qualitative best fit and the linear regression solution didn’t match, 
why do you think that is? You might want to consider the presence of outliers, how 
vertically aligned data impacts linear regression, etc. 


(d) Linear regression seeks to minimize the vertical error between the data and the best fit 
solution- is that optimal for the data set? What is another approach that could lead to a 
“better” fit. 


Note: These plots were created using the code here. All of the data is here. 


Note 2: How you visualize data is very important, and greatly impacts our qualitative idea 
of what is a “better” fit. This is made very apparent for scanz below. I have created the scanz plot 
using the “axis equal” command in Matlab, which ensures an equal range in x and y. Try plotting the 
data without that command or with the “axis square” command. Would you draw the same fit line? 
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Scan 1- Clean Data 
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Figure 26.5: Clean data from Scan1. Please add your fit lines using Miro. 


Scan 2- Clean Data 





0.3 


0.2 


0.1 


3.2 3.3 3.4 3.5 3.6 3.7 3.8 3.9 
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Figure 26.6: Clean data from Scanz. Please add your fit lines using Miro. 


Scan 3- Clean Data 
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Figure 26.7: Clean data from Scan3. Please add your fit lines using Miro. 
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Scan 4- Clean Data 


Figure 26.8: Clean data from Scanq. Please add your fit lines using Miro. 





26.3.2 Principal Component Analysis for Line Fitting 


Linear regression defines the line of best fit in terms of the sum of squared distances, measured vertically, 
between the data points and the line (see Figure 26.13). However, when determining the best fitting line for 
a laser scan, there’s nothing special about the vertical direction. In fact, it would make as much sense to 
minimize the sum of the squared horizontal distances. In this context, a much more natural way to think 
about the line of best fit is to minimize the perpendicular distances between the line and the data points (see 
Figure 26.13). 
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Figure 26.13: Laser scan points (gray dots), a proposed fitted line, and two different notions of error. The red 
dashed lines provide the vertical distance (which is used in linear regression). The blue dashed lines provide 
the perpendicular distance which is a more natural way to define line of best fit in the context of fitting lines 
to laser scan data. 


Exercise 26.7 


Think about how to use principal component analysis to determine the line of best fit that minimizes 
the sum of squared perpendicular distances as shown by the blue dashed lines in Figure 26.13. You 
might recall that in PCA, we found the directions of greatest variation in an (x, y) dataset by first 
creating a matrix of mean-centered data, 


T— Pe Yi — Py 
T2 — Pe Y2 — Py 


1 U3 — Me Y3— by 


Ve 
ZN — [lx YN — by 
and then finding the eigenvectors of the co-variance matrix, R = A7 A. 
1. Describe conceptually why you think this algorithm will achieve the desired goal. 


2. Write pseudocode to describe the steps you will need to take. You should consider what an 
eigenvector represents. (Hint: if you translate your data, be sure to translate it back. ) 


Exercise 26.8 


In MATLAB, do the following for the Cartesian data for scans scan2.mat and scan3.mat. 

Note: Make use of the code snippets above to remove zeroes and convert the data from polar to 
Cartesian coordinates. To find the best fit line using PCA, the pca function in Matlab will be useful. 
Remember you can always use help pca or doc pca to learn the usage details of the pca function. 
Once you have attempted the Matlab solution as a group, a working solution is here. 


1. Compute the line of best fit using PCA. 
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2. Plot the data points, line of best fit from PCA, and line of best fit from linear regression. Be 
sure to note which line is which. 


. How does the fit using PCA differ from your qualitative fit from above, and from the fit using 


linear regression? Why do you think this is? Discuss how the difference between linear 
regressions minimizing vertical error, and PCA identifying the direction of greatest (and least) 
variation impacts the fit lines. 


CO 


26.4 Least-Squares (Optional) 





In least squares fitting, we want to find the line, y = mz + b, which lies ’closest’ to all our data points. To 
express this quantitatively, we want to find the line which minimizes the mean of the squared error of our 
data set from the line. Recalling our definition of the mean, we can rewrite the mean-square error as: 


N 
MSE(m,b) = 307 (ma; +))? (26.13) 


i=l 





The key insight to make here is that the mean-squared error is a function of two variables, m and b. 

The process of finding the best-fit straight line therefore amounts to finding the values of m and b that 
minimize the mean-square error function. Since the mean-square error is a function of two variables we 
need to compute the partial derivatives, and then set of them equal to zero in order to find the critical points 
of the function: 


3. Show that the partial derivative of the MSE function are: 





IMSE ie 
An 255 xi(yi — (ma; + b)) (26.14) 
i=l 
IMSE net 
Ob 25 (yi — (ma; + d)) (26.15) 
j=l 


4. Show that setting each partial derivative equal to zero results in the following equations (after some 
simplifying): 


N N N 
m>_ 3; +b) Li= SS siy: (26.16) 
i=1 i=1 i=1 


N N 
mS ~at+Nb=S_ yi (26.17) 
i=1 i=1 


Notice that both of these equations are 1inear in m and 6, and we can therefore write this system of linear 
algebraic equations in matrix-vector form, 


viet a} ye vi | WE = Died Liyi 
Dini 2 N b via Vi 
and find the solution for m and b by solving this linear system. 


5. Under what data conditions does a solution not exist to this problem, i.e. when is the determinant of 
the data matrix zero? 
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How do we know if this value of m and b has indeed led to a minimum of the mean-square error function? 
We saw earlier that we can classify the critical point using the determinant of the Hessian matrix. 


6. Show that the Hessian matrix is simply given by the data matrix. Why is this true in linear regression? 
7. Why is the determinant of the Hessian matrix > 0 unless all of the x; values are the same? 


Hopefully you are now convinced that the solution we determined is indeed the minimum! 
To conclude this section, let’s look again at the mean-square error function 


N 
MSE(m,b) = + lu (ma; +))? (26.18) 


i=l 





and formulate this using vectors and matrices. Let’s define the error vector e whose components are 
e; = Ys — (ma; + b) (26.19) 


The mean-square error function is therefore 
1 fr 
MSE(m, b) = we @ (26.20) 


Now let’s define the vector y with components y; and the vector x with components 2;. The error vector 
can then be written as 
e=y-—mx-— dl (26.21) 


where 1 is a vector with 1 as every component. If we now define the matrix X as follows 


X= [x 1] (26.22) 
and the vector p as follows 
p= "| (26.23) 
then the error vector can be written as 
e=y-—Xp (26.24) 


With these definitions in mind, let’s now rewrite the linear system of equations that determines the best 


values of m and b 
N 2 N : N Lays 
dic UG Dian Fi | | Mt | = duis} ViVi | (26.25) 


iat Zi N b iat Yi 
Since the matrix X is an N x 2 matrix, the product X?X is a 2 x 2 matrix and in fact we see that (check for 
yourself!) 
N 2 N F 
x?xa=| Lig Liat (26.26) 
Dini Fi N 


Wow! That’s amazing, right? Not only that, the product X7’y is a 2 x 1 matrix and in fact we see that (check 
for yourself!) 


iat Yi 


So what, you ask? This means that the linear system of equations that defines the best fit line can be 
expressed in matrix-vector form as 


N 
XTye Digs TMi | (26.27) 


(X?X)p = XTy (26.28) 


which is precisely the expression we derived last semester using orthogonal projection! 
So, in summary: 


¢ Form the matrix X = [x 1] 
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- Compute the matrix product X7X 

- Compute the vector X7y 

- Solve the linear system of equations defined by (X7X)p = X"y for the vector p. 
+ Compute the error vector e = y — Xp using this solution for p. 


Evaluate the mean square error function, MSE = were 
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Solution 26.1 
1. 0=2.5 radians, R=10 


2. 9=1.18 radians, R=13 


Solution 26.2 
1. X=1.73, Y=1.00 
2. X=1, Y=-1.73 
Solution 26.3 
# and 6 are orthogonal, so their dot product is zero. 


Solution 26.4 


The f vector has length 1 and points in the direction of increasing r, and 6 has length 1 and points 
in the direction of increasing 0, orthogonal to r. 


Solution 26.5 
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3. The samples making up the line in part a are all at zero distance, and appear as a cluster and 
the center of the polar plot. The parabola from part a becomes the line in part b. 


4. one implementation: 
index=find(r~ =o); 
r_clean=r(index); 
theta_clean=theta(index); 
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An example code section that could do this whole process is here. 
Solution 26.6 
Scan 1- Clean Data and Fit Lines 


0 Clean Data 
Linear Regression 





06 04 02 0 O02 04 06 O08 1 12 
[m] 


Figure 26.9: Best fit using linear regression for scan1. 
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Scan 2- Clean Data and Fit Lines 





QO Clean Data 
0.3 Linear Regression 


0.2 


0.1 


3.2 3.3 3.4 3.5 3.6 3.7 3.8 3.9 


Figure 26.10: Best fit using linear regression for scanz. 


_ Scan 3- Clean Data and Fit Lines 


0 Clean Data 
Linear Regression 


0.725 
0.73 
0.735 

—E 0.74 
0.745 


0.75 





1.5 1 0.5 0 0.5 1 1.5 
[m] 


Figure 26.11: Best fit using linear regression for scan3. 
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Scan 4- Clean Data and Fit Lines 


0.6 


O Clean Data 
0.4 Linear Regression 


m] 
oo 
> 


-1.2 


-1.4 
-1.5 





Figure 26.12: Best fit using linear regression for scanq. 


Solution 26.7 


1. We can recall from Module 1 that PCA identifies the direction of greatest variation in a data set 
(this direction is given by the eigenvector associated with the largest eigenvalue). Conceptually, 
the direction of greatest variation should be orthogonal to the direction of least variation. So, 
the direction perpendicular, or orthogonal, to the line found using PCA should minimize 
variation, and therefore minimize the sum of squared perpendicular distances. 

2. (a) Convert data from polar to cartesian coordinates. 

(b) Calculate the x and y means for the dataset. 
(c) Use the x and y means to center the data. 
(d) Find the singular value decomposition (SVD). 


(e) Identify the direction of greatest variation in the dataset as the eigenvector associated 
with the largest eigenvalue. 


(f) Translate the data back to its original positions. 


Solution 26.8 
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Scan 2- Clean Data and Fit Lines 


O- Clean Data 
Linear Regression 
= =- =PCA 





351 352 353 354 355 356 357 3.58 3.59 
[m] 


Clean data and best fit lines using linear regression and PCA for Scan 2. 


Scan 3- Clean Data and Fit Lines 
-~0.72 


OO Clean Data 
0.725 ———— Linear Regression 


-0.73 


-0.735 





Clean data and best fit lines using linear regression and PCA for Scan 3. 
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and LIDAR 





Schedule 
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? Learning Objectives 


Concepts 


« Create a matrix that rotates a vector from one 2D coordinate system to another that shares its 
origin but is rotated an angle, 0, clockwise, relative to the original coordinate system. 
« Create a matrix that translates the origin of a 2D coordinate system to another known point. 


MATLAB skills 


+ Compute the vector coordinates of a vector in a global matrix to a rotated coordinate system 
with a translated origin. 


« Determine the location of the NEATO in the global frame in response to LIDAR data. 


Overview 


In this overnight activity you are going to think about transforming points between different frames of 
reference, and how to apply this data collected by the LIDAR on the NEATO in order to create a "map" of 
the room. Rather than translating and rotating points, we will be using translation and rotation matrices to 
express points in different frames of reference. For example, imagine we want to refer to a point (a,b,c) ina 
global frame (G), from within a different frame (M), as shownn in Figure 27.1. Our task would be to translate 
the origin and transform the G-frame to the M-frame. How would we do that? Let’s first remember how we 
might transform the frames when they share an origin. 
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GLOBAL 
M ° Frame 


ORIGIN 





eRIGIN 


> a. Werstorm Tyrenslute a 


Ce = cyprelinat * “origin “Ve 
retaty Trans lattin 
matrix matrix 


Figure 27.1: The global frame of reference (G) differs in origin and shape from the M-frame. 


27.1 Frames of Reference 


In robotics and indeed many other applications, it is often useful to express points using different coordinate 
systems. You have already done this to a certain extent in Module 1 when you expressed vectorized images 
as linear combinations of Eigenfaces. In robotics applications, it is beneficial to express points relative to a 
fixed origin (e.g. a point designated as the origin in a room) and orthogonal basis vectors. In other cases, it is 
convenient to express points relative to an origin on the robot itself, with one basis vector in the direction of 
motion, and the others in orthogonal directions. Here, we will first develop some tools to translate points 
from one coordinate system to another, and apply these tools in the context of the NEATO. You will then 
be able to take points expressed in a coordinate system centered on the robot (e.g. from sensor data), and 
represent them in terms of a fixed coordinate system (e.g. with a corner of a room as the origin). We will 
work in 2D, but we can just as easily extend this discussion to higher dimensions. 


27.1.1 Coordinate Systems with the Same Origin 


A coordinate system consists of an origin and a set of basis vectors. Recall that a set of vectors form a basis 
if they are linearly independent, and if they are mutually orthogonal then we have an orthogonal coordinate 
system. 

The standard basis vectors for 2D are usually labelled i and j, but they are sometimes written as e; and 
€2, or e, and e,, or X and ¥. From now on, we will assume that the global reference frame (frame G) is 
defined by the standard basis vectors, but just to be very clear we will use a subscript and write ig and jg as 
the basis vectors of the global frame G. 

Points in 2D are expressed in terms of the basis vectors, and we refer to the component of the vector as 
the coordinates of the point. For example, the point A in Figure 27.2 has coordinates (4,3) when expressed 
in terms of the standard basis vectors. We might also write the position vector of A as 


rg = 4ig + 33a 


ra=|5| 


All of these refer to the same point, but the first and last representations imply the basis vectors, while the 
second representation makes it explicit. We use the notation rg to be clear that this is the position vector of 


or express it as a row or column vector 
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Figure 27.2: The coordinates of the point (4, 3) are the projections of the position vector onto the relevant 
basis vectors. 





Figure 27.3: The frame M has the same origin, but the basis vectors are rotated by an angle of 6. The 
coordinates of the point (4, 3)g can be expressed in terms of the new frame M. 


point A when expressed in the frame G. Notice that the coordinates (ag, yc) of the point A are simply the 
projection of the position vector onto the relevant basis vectors, 


ta ="ra-ig, ye=ra-jg 


Since these basis vectors are mutually orthogonal the coordinates are simply (4,3) as expected, but again 
for clarity we will write (4,3)g to mean that these are the coordinates in the frame G. You may recall that 
we met this concept in detail back in module 1 when we learned about decomposition. 

How do we express the same point in terms of a new set of basis vectors, i,y and J,,;? Mathematically, 
we are trying to express the vector rj as a linear combination of these vectors 


tum =tmMim+YymMjJy 


where the coordinates of the point are now (x7, yy), Le. the x and y coordinates of the point in the frame 
of reference M. See Figure 27.3. 

The components of the point A expressed in this coordinate system is again the projection of the position 
vector in the frame G onto each basic vector of frame M in turn, 


tM =Ya-im, ym =Ya'jy 
Since rg = &g ig + ya Jg we see that 


tm =%tgig:im +yajq‘im, ym =%aig:jyt+yeja‘ju 
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Whilst this looks cumbersome, it becomes a lot clearer when we use the following matrix-vector formulation 


| _ Fe ‘im Jg° - Ba 

YM 1GeJm Ja‘Iul Le 

This matrix is the transformation matrix from the global reference frame (frame G) to the new reference 
frame (frame M), and we will often use the notation Rac when referring to this transformation matrix 


ru = Ruare 


For example, consider the frame M shown in Figure 2, which is simply the global frame rotated counter- 
clockwise by an angle 6. The basis vectors in this frame are 


3,, — |°% 6) . _ |—siné 
M~ |eing|?IM ~ | cos 
which means that the transformation matrix from frame G to frame M is 


Reve | cos@ sin | 


—sin@ cosé 


which is almost identical to the rotation matrix we met in Module 1. Rather than rotating the point through 
@ degrees, it rotates the coordinate system through 6 degrees and expresses the point in terms of this new 
coordinate system. If 0 = 7/4, the point (4,3) is expressed as 


tia val 


ru 


ou = (40 


or equivalently (7/2, —1/vV2) az. 
What if we have the coordinates of a point in frame M, and we wish to express them in frame G? Referring 
to the transformation matrix we developed earlier, we can express this using the matrix inverse 
-1 

ro = R MGIM 

Since this inverse must be the transformation that takes points from frame M to frame G it must be true that 
-1 

Rem =R MG 

Transforming from frame M to frame G corresponds to a clockwise rotation of # so that Rew must be the 


transpose of Riva, 


Rew = & 6 —sin 


sin@  cos@ 


For example, consider the point (1, 2) ,y in frame M. The coordinates of this point in frame G must be 


= A we 





1/V2 1/72} |2 
_ f-1/v2 
“= Be 


or simply (—1/V/2,3/V2)a. 


Exercise 27.1 


CHAPTER 27. HOMEWORK 6: FRAMES OF REFERENCE AND LIDAR 255 


The frame M is a counterclockwise rotation of the global frame G by 7/3 radians. 
. Draw the basis vectors for frame G and frame M. 


. Plot the frame G coordinates (2, —1)g. Now express the frame G coordinates (2, —1)g in the 
frame M, and confirm that this is the same point by plotting it using the frame M. 


. Plot the frame M coordinates (3, —2) 17. Now express the frame M coordinates (3, —2) 4 in 
the frame G, and confirm that this is the same point by plotting it using the frame G. 





27.1.2 Coordinate Systems with a Different Origin 


In addition to defining new basis vectors, we often encounter situations in which we use a new origin. In 
Figure 27.4 we define a global frame with basis vectors ig and jg, and origin Og. We also define a frame M 
with basis vectors ing and j,,, and origin Oj. How do we transform points from frame G to frame M, and 
vice versa? 

Fortunately, we already met the concept of translating points in Module 1, and here we will utilize these 
ideas to translate the origin before rotating the basis vectors. Recall from Module 1 that in order to translate 
a point we can use the translation matrix 


1 0 % 
T=|0 1 ty 
00 1 


where t, and t, are the components of the translation, and the translation matrix acts on the vector 


x 
y 
1 


For example, let’s consider the case when the origin of frame M is located at (a, b)g. The coordinates of 
this point in frame M must be, by definition, (0, 0) a7. The components of the translation must therefore be 
—a and —b and the translation matrix that moves the origin of frame G to frame M is then 


1 0 -a 
Tuc =|0 1 —b 
00 1 


and the translation matrix that moves the origin of frame M to frame G 


1 0a 
Tem = |0 1 6b 
001 
In order to be consistent, we should adapt our rotation matrix so that it acts on a vector with 1 in the third 
slot 
cos@ sind 0 
Rua = }|—sin@ cosé 0 
0 0 1 
and 
cos@ —sind 0 
Rem = |sind cos@d@ O 
0 0 1 
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Figure 27.4: The frame M has an origin at (2, 3)q, and the basis vectors are rotated by an angle of @. The 
coordinates of the point (3, —1)g can be expressed in terms of the new frame M. 


We are now ready to transform a point from frame G to frame M, by first translating the origin of frame 
G to the origin of frame M, and then rotating the basis vectors from frame G to frame M. The position vector 
of an arbitrary point is then 
tu = RucTuecra 
We can, if we choose, combine the translation with the rotation into a general transformation, but we don’t 


have to, and there are some advantages to keeping the distinction clear. 
Transforming back from frame M to frame G would be accomplished with 


rg = (RucTmc) ‘tM 


-1 p-l 
>Ir¢ Ti¢eRuctM 


We’ve already seen that the inverse of the rotation matrix is just the transpose of the original and thus 
(Ryza)! = Rew. This makes sense. To rotate back from frame M to frame G we use the Rg. Further- 
more, the inverse of the translation matrix T j¢q is just the translation matrix Tg¢jy. Notice, however, that 
we first apply the inverse rotation and then the inverse translation, 


rg = TewReuru 


For example, let’s express the point (3, —1)¢ in frame M, which has its origin at (2,3)¢, with basis 
vectors rotated counterclockwise by 7/4. The coordinates in frame M are therefore 


1/V/2 1/V2 0] f1 0 -2) [3 
tru = |-1/V2 1/V2 0| }O 1 —-3{ |-1 
0 Oo 4). )0 o 2 1 
1/V2 1/v2 0] [1 
=>ru = |-1/V2 1/V2 0| |-4 
0 0 1 {1 
—3//2 
=>Ivw = 


—5/V2 
1 


which means the coordinates are (—3/./2, —5/./2) wv. Let’s check to see if we can transform this point back 
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from frame M to frame G. The coordinates in frame G are therefore 


1 0 2] f1/V2 -1//2 0] [-3//2 
ro = |0 1 3] |1/V2 1/V¥2 0} |-5/V2 
0.0. a 0 0 1 1 
ims a a 
>re¢ = |0 1 3] |-4 
00 1) ]}1 
3 
>Yroq = j-l 
1 


which is just where we started! 


27.2 Key Points 


+ A frame of reference is defined by an origin and a coordinate system. 
+ A coordinate system is defined by a set of basis vectors. 


+ The coordinates of a point correspond to the components along each basis vector of a position vector 
from the origin to the point. 


« The coordinates of a point are therefore dictated by the frame of reference. 
¢ The notation rg or (x, y)g refers to the coordinates of a point in frame G. 
+ Points can be transformed from one frame to another using matrix multiplication. 


+ If frame M has origin located at (a, b)c, and has basis vectors rotated counterclockwise by 0, then the 
transformation from frame G to frame M is 


ru = RucTucra 


where T yc is the matrix that translates the origin of frame G to frame M, and R wc is the matrix 
that rotates the basis vectors of frame G to frame M: 


cos@ sin@ O 


Ryc = |—sin@ cosé 0 
0 0 1 
1 0 -a 
Tua=|0 1 —-b 
00 1 


« Transforming back from frame M to frame G involves the inverse of these matrices 
2) Tl R71 
Ya = 1ucuctlM 


« These concepts and quantities can be used to transform LIDAR data to the room frame in order to 
create a map. 


Exercise 27.2 


The frame M is a counterclockwise rotation of the global frame G by 7/3 radians, and has its origin 
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at (-3, lg. 
. Draw the origin and basis vectors for frame G and frame M. 


. Plot the frame G coordinates (2, —1)g. Now express the frame G coordinates (2, —1)g in the 
frame M, and confirm that this is the same point by plotting it using the frame M. 


. Plot the frame M coordinates (3, —2) ;¢. Now express the frame M coordinates (3, —2) 4 in 
the frame G, and confirm that this is the same point by plotting it using the frame G. 
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O 


Figure 27.5: Illustration of NEATO with different coordinate systems with origin at the center of rotation of 
the LIDAR, and in the origin of a fixed frame of reference (e.g. origin of the room). 


27.3 Application to the NEATO 


The LIDAR reading provides a range and angle with respect to the center of rotation of the LIDAR sensor on 
the NEATO, with the angle measured relative to the front of the NEATO as illustrated by 6 in Figure 27.5. 
The square object is located at a distance r and angle @ as measured by the LIDAR on the Neato. 

For further reference, consider Figure 27.6 which indicates the location of the LIDAR relative to the 
center of rotation of the Neato. The center of rotation of the Neato is indicated by the magenta circle and is 
the origin of two orthogonal unit vectors iy and jj, (thicker, light blue arrows). For the physical Neato, you 
could measure the distance d between the origin of the reference frame based on the LIDAR and the origin 
of the reference frame based on the Neato’s center of rotation. For the simulated Neato, the origin of the 
frame based on the LIDAR is located at position —0.084m iy + 0m jy, relative to the origin of the Neato 
coordinate system. 

The orientation of the Neato relative to the absolute horizontal axis of the room is indicated by the angle 
@. Depending on your application, you may wish to express the position of the object (the box, in this case) 
in terms of a coordinate system relative to the center of rotation of the LIDAR sensor with unit vectors iz, 
and j,,, center of rotation of the Neato with the unit vectors iy and jj, or the global frame of reference 
indicated by the origin marked "O" and the blue arrows for which the unit vectors are ig and jg. 


Exercise 27.3 


1. Suppose that the LIDAR returns a value of (7,0) when scanning an object. With reference to 
Figure 27.5, please express the location of the object with respect to the LIDAR frame L. 


2. With reference to Figures 27.5 and 27.6, please express the location of the object with respect 
to the NEATO frame N 


3. Please express the location of the square object in the global frame G. Assume that the center 
of rotation of the NEATO is located at (7, yn )G 
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axis of room 





Figure 27.6: Illustration of NEATO with origin at center of rotation. 


Exercise 27.4 


Advice for this exercise: 


» Before doing any coding, make sure you have a good sense of the chain of transformations 
needed to express the points in the global frame (this was the focus of the preceding exercise). 


+ Write out some pseudocode for how you are going to enact these transformations. 


+ Consider writing your code using a proper MATLAB script (.m). You may want to create a 
function that takes as input scan data and information about the location where the scan came 
from and returns the points in the global frame. 


+ Create intermediate visualizations (e.g., scatter plots) as you move from the polar representation 
in the LIDAR frame all the way to the global frame. Scrutinize these intermediate plots to 
make sure they make sense. 


Now, we will use these techniques to take LIDAR data and build a map with respect to a fixed 


co-ordinate frame. In the simulator, we have defined an origin, x, and y axes, as well as placed objects 
on the floor at fixed locations in the Gauntlet. Your job is to build a map of the Gauntlet when 
the NEATO is placed at different positions and orientations. The map will be built using the 
global coordinate frame and unit vectors in the ig and jq directions. Recall that the LIDAR data 
is provided to you in polar co-ordinates using the coordinate frame with the origin at the center 
of the LIDAR sensor and the basis vectors pointing in the forward direction of the LIDAR, and 90° 
counter-clockwise from it. 


To start the Gauntlet world, use the following Matlab command. 
>> qeasim start gauntlet_final 


1. Read through the parts (3)-(7) below. You will be producing a total of 5 plots for this exercise. 


2. For the sake of logistics, you can collect all of your data (four different placements of the Neato) 
first, and then construct the plots. To do this, edit collectScans.m by modifying the coordinates 
and angles in the placeNeato.m function calls. Note: both of these scripts are already in 
the simulated environment, so you do not need to download them. 
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. By default the NEATO starts at the origin of the global frame facing in the direction of the ig 
axis. Note that if you needed to reposition the Neato at this location, you can run the MATLAB 
command placeNeato(0,0,1,0). In this position and orientation, collect data from 
the LIDAR. Express the LIDAR data in the fixed co-ordinate frame. Plot the data in MATLAB 
using the fixed reference frame and compare it to the locations of the objects in the Gauntlet. 


. With the NEATO at the origin, rotate it through some angle ¢ (you can just pick your favourite 
angle here) and repeat what you did for the previous part (i.e., collect LIDAR data, translate 
to the fixed co-ordinate frame, plot in MATLAB, compare to the locations of the physical 
objects in the Gauntlet). In order to rotate the Neato by an angle ¢ you can run the MATLAB 
command placeNeato(0, 0,cos(phi),sin(phi) ). 


. Now, move the NEATO to a different location (pick your favourite location in the Gauntlet), 
but keep it pointing in the same direction as the ig axis, and repeat what you did for the 


previous part. If you want to move the Neato to position (a, b)g but still have it iy oriented 
along ig, you can run the MATLAB command placeNeato(a,b,1,0). Make sure your 
Neato doesn’t crash into anything when you move it. Note that it is a bit difficult to see where 


the axes of the Gauntlet coordinate system are located, but the grid shown in the visualizer is 
1m by 1m. 


. Now, move the NEATO to a different location and pointing in some arbitrary direction, and 
repeat what you did for the previous part. 


. Plot the locations of all four scans in the fixed (global reference frame) on the same plot (this 
is a great way to see if your code is correct). If all went well, the scans should mesh together 
well. 
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Solution 27.1 





Solution 27.2 


1. Parts 1 and 2: 





2. Part 3: 
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Solution 27.3 


1. We will denote the location of the object in the LIDAR frame L as r_. If we measure the polar 
r COs | 


coordinates of the object then its location is rz, = | : 
rsind 


2. We will denote the location of the object in the NEATO frame as ry. It is a translation with 
r cos 6 — 4 


respect to the LIDAR origin. The location of the object is now ry = | ee 


3. The NEATO is translated and rotated with respect to the room. The transformation matrices 


are 
1 02 N 
Ten =}9 1 yn 
00 1 
cos@ —sind 0 
Ren = |sin@ cosd 0 
0 0 1 
Multiplying these out and transforming the coordinates of the object in the NEATO frame 
leads to 


rcos(@ + ¢) —dcos@+ an 
rsin(@ + ¢) —dsing + yn 
where we have used a trig formula. 


Solution 27.4 
Our solutions are available in the following two MATLAB files. 


* collectScansSolution.m: after connecting to the simulator, run this function to position the 
robot and collect the scan data. The data is stored ina . mat file for subsequent process. 


* makeGauntletMapSolution.m: after running col lectScansSolution, you can run this 
function transform each scan to the global frame and plot them on a single plot. 


Chapter 28 


Week 7: Scalar and Vector Fields, The 
Gauntlet 
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? Learning Objectives 


Concepts 


1. Differentiate between scalar and vector fields. 
2. Determine the Jacobian, the divergence, and the curl of a vector field. 


3. Build a scalar potential field using sources and sinks. 


28.1 Scalar and Vector Fields - Definitions 


Scalar and vector fields are mathematical objects which are ubiquitous across many disciplines. You have 
already been working with both of these concepts already, but now is a good time to formalize the definitions 
and deepen our understanding of these ideas. 

A scalar field is a function which is defined across a space of inputs and outputs a scalar value. The 
input space can be of any dimensionality. As an example, a function which defines the temperature profile 
at all points in the air in the QEA classroom, T(x, y, z) is a scalar field with a three dimensional input and a 
one dimensional output. The word “field” tells us that the input is a vector, and the word “scalar” tells us 
that the output is, well, a scalar. 

Another example of a scalar field is the elevation of a mountain as a function of two-dimensional position, 
H (x,y). A scalar field then is a function f which accepts a vector as an input and outputs a scalar—we can 
either use the notation f(x, y, z) which specifies the components of the input, or the more general notation 
f(r). If we want to be even more specific, we can write f : R’ — R, which is shorthand notation for f 
takes real values in N dimensions as input and outputs a real value. 

A vector field is a function which is defined across a space of inputs and outputs a vector. An example of 
this would be the velocity of the air currents at all points in the QEA classroom v(z, y, z) = vzit vyj+ vz k, 
where v,, is the component of the velocity in the x-direction etc. (Although this is a widely used notation, 
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it can be confusing because v,, is also the notation used to define the partial derivative of v with respect 
to x!) Another example is the gradient function of the surface of a mountain VH = ony + al A vector 
field then is a function F which accepts a vector as an input and outputs a vector of the same number of 
dimensions—again we can either use the notation F(z, y, z), or the more general notation F(r), where 


F:RY > RN. 


Exercise 28.1 


Which of the following quantities could be considered a scalar field or vector field (or neither). 


. The temperature at all points in your room right now. 

. The temperature gradient at all points in your room right now. 
. The velocity of a bird in flight over the course of a day. 

. The population density at all points in the USA right now. 


. The wind velocity at all points in the USA right now. 


Exercise 28.2 


Generate a list of at least 3 quantities and classify them as a scalar field or a vector field. 





28.2 Visualizing Scalar and Vector Fields 


We’ve already spent quite a bit of time visualizing scalar and vector fields. Recall that for scalar fields we 
often plot contours, and for vector fields we plot, well, a set of vectors defined at lots of points in space. 


Exercise 28.3 


For each of the functions below: 
a Determine if the function is a scalar or vector field. 
b Predict what the scalar or vector field will look like based on the equation. 


c Visualize the scalar or vector field using CalcPlot3D and compare to your prediction. 


Visualizing each of the functions in CalcPlot3D requires slightly different settings. We will provide a 
starting point, but feel free to play with the plotting to achieved the desired visualization. 


1. f(x,y) = (@— 1)? + (y — 2)? 
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Contour Plot Settings: > 
First level value: |-1 

stepxze [D2 

Name ofcccioun: [14 | 
ssfpideteashion [46 | 


Click on the 3D Plot for 3D view. 
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zs “ ] 7 wy 
(Greate Pot) choose “Function: z=f(x,y) 


Comour color | Y 














Add a Constraint Carve 








Clicking here opens the 
“Contour Plot Settings” pane. 
Click “Create Plot” to graph 
contours. 














Welcome to CalcPlot3D! 
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Try different values for 
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4. F(x,y,2) = (Qy— zit (w+ y? — 2)j + (4y — 32)k 


Use the "Vector Field" setting as above, but include all three dimensions. 
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28.3 Jacobian, Divergence, and Curl of Vector Fields 


We’ve already met partial derivatives, and the gradient operator V = [Ox Oy d,); which is the multi- 
dimensional equivalent of the derivative. We can apply the gradient to vector fields in a number of ways. 
The material here is a very brief introduction and is focused on introducing terminology, not interpretation - 
that will come later! 

Given a vector field F(x, y, z) = X(x,y,z)i t+ Y (a, y, 2)j + Z(a, y, 2)k its Jacobian is the matrix of 
partial derivatives 





OX OX OX 

Ox oy. Oz 

JF OY oO oY 
oh te fe) Oz 

82 az (8% 

Ox Oy Oz 


For example, the derivative of the vector field F(x, y, 2) = x24 + xyzj + (a? — 2?)k is the matrix 


2x 0 0 
JF=/yz wz xy 
27 0 —2z 


. We often simply refer to the Jacobian matrix as the “derivative” of the vector field, but that can be confusing. 


Exercise 28.4 


Find the Jacobian of the following vector fields. 


1. F(z, y, 2) = (8a + 4y)it+ (4y — 5z)j + (a@+y—z)k 





2. F(z, y,2) = yat ag +acyk 


—————SSS eee 


Consider a vector field given in Cartesian coordinates as F(x,y,z) = X(a,y,z)i+ Y(a,y,z)j + 
Z(a,y, z)k. The divergence of F is the scalar field 





; OX OY OZ 
divF = cs + By te ae 


For example, the divergence of F = sin(x) cos(y)i + x?yzj + (sin(z) — 2?)k is the quantity divF(«, y) = 
cos(x) cos(y) + «7z + cos(z). 


Exercise 28.5 
Find the divergence of the following vector fields 


1. F(z, y) = cos(x) sin(y)i — sin(x) cos(y)j 


2. F(z, y, z) = ysin(z)i — x sin(z)j + cos(z)k 
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Exercise 28.6 


Show that the divergence of F is the dot product of the gradient operator with the vector field, i.e. 


divVF =V-F 


EEE 


Consider a vector field given in Cartesian coordinates as F(x,y,z) = X(a,y,z)i+ Y(a,y,z)j + 
Z(a, y, z)k. The curl of F is the vector field 





OZ ON 58 OZ. OK 4 GOV ORS 
aa aay az? (35 az 3" (35 Oy es 





Exercise 28.7 
Compute the curl of the following vector fields 
1. F(a, y) = cos(x) sin(y)i — sin(a) cos(y)j 


2. F(z, y, z) = ysin(z)i — x sin(z)j + cos(z)k 


Exercise 28.8 
Show that the curl of F is the cross product of the gradient operator with the vector field, ie. 


curlF =V x F 


CS SS) 


28.4 Introduction to Potential Fields 





In an earlier assignment we used the method of steepest ascent to navigate the NEATO to the top of a 
“mountain”, which we defined using a scalar field H (sx, y). 

In the Gauntlet challenge we are going to use targets (bucket of benevolence) and objects (walls, boxes, 
etc) to create an artificial mountain landscape, and we will navigate the NEATO using the method of 
steepest descent so as to avoid the obstacles and hone in on the target. (We use steepest descent in order 
to connect this with ideas from physics.) 

To accomplish this task, we are going to introduce a particular scalar field V(x, y) which can be used to 
create useful mountain landscapes. It is known as a potential field. 


Exercise 28.9 


Let V(x, y) = In \/a? + y?. Note that V is not defined at the origin! 
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. What is V in polar coordinates (note: this question is just here to make you realize that it’s 
actually a pretty function, and to make it easier to visualize)? 


. Create a contour plot of V. 
. Determine the gradient field defined by VV, and visualize it. 


. How would a NEATO performing gradient descent behave if you put it on a Flatland defined 
by V and started it at (1,2)? 


Exercise 28.10 


Now consider V (a, y) = In \/x? + y? — In,/(x — 1)? + y?. Notice that there is a strong “trough” 


at (0,0) and a strong “peak” at (1,0). The sign in front of the logarithm determined whether it is a 
peak or a trough. 


1. Create a contour plot of V. 
2. Determine the gradient field defined by VV, and visualize it. 


3. How would a NEATO performing gradient descent behave if you put it on a Flatland that 
looked like V and started it at (1, 2)? 


Exercise 28.11 


In the last question, a NEATO would be attracted by the trough at (0, 0) but repelled by the peak at 
(1,0). We will refer to the point at (0,0) as a “sink” and the point at (1, 0) as a “source”. 


1. Define a scalar field V (a, y) that has a sink at (0,0), and sources at (1,0) and (2,3). 


2. Visualize the scalar field V and the gradient field VV. 


3. How would a NEATO performing gradient descent behave if you put it on a Flatland that 
looked like V and started it at (1, 2)? 


CO 


28.5 Introduction to The Gauntlet Challenge 





The last challenge of the Robotics Module is The Gauntlet. In this challenge, you will be using the a combi- 
nation of potential fields and gradient descent to help your robot navigate through a cluttered environment 
to the Barrel of Benevolence, as seen in Figure 28.1. 
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Obstacle 
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Figure 28.1: In the Gauntlet challenge you will navigate your robot from the starting point to the Barrel of 
Benevolence, avoiding obstacles as you go. 


Exercise 28.12 


The Gauntlet Challenge brings together many topics from the robotics module, so it is valuable to 
take a moment to map out the challenge before diving in. In particular, the Gauntlet Challenge has 
three levels, and levels 2 and 3 will require learning some additional material beyond what we have 
covered in class. 


1. Read the description of The Gauntlet Challenge in Chapter 30. Pay particular attention to 
the three levels of the challenge, and note the differences between the levels. Resolve any 
questions you have with your group and/or an instructor. 


. Create a concept map of the challenge. Identify relevant math concepts, skills, tools, past 
assignments, scripts you've already written, etc. that are relevant to this challenge. List 
anything new you will need to learn (especially for challenge levels 2 and 3). 


. At a high level, outline (5-ish) major steps in solving the challenge. What issues do you 
anticipate at each step? 


. For each step, plan how you will verify that what you’re doing is working. This plan should 
involve making some plots. 


. Answer this survey by the end of class or we will pair you with your nemesis. 


. If you finish early, consider looking at the option material on the RANSAC algorithm in Chapter 
31. 





CHAPTER 28. WEEK 7: SCALAR AND VECTOR FIELDS, THE GAUNTLET 271 


Solution 28.1 


1. T (x,y,z): scalar field because it takes in a vector, e.g., (x, y, z),and puts out a scalar, T, at 
(x,y, 2). 


2. VT (a,y,z): vector field because it takes in a vector (x,y, z) and outputs a vector, VT at 
(x,y, 2). 


3. v(t): neither because scalar in and vector out 
4. p(x, y): scalar field because vector in and scalar out 


5. V(a, y): vector field because vector in and vector out 


Solution 28.2 
Hopefully lots of examples here! 


Solution 28.3 
1. The contours will be circles centered at (1, 2). 


2. The contours will be ellipsoids (axes 1,2,3) centered at the origin. 
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Solution 28.4 
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Solution 28.5 
1. divF = —sin() sin(y) + sin(x) sin(y) = 0 
2. divF = 0+ 0 —sin(z) = — sin(z) 


Solution 28.6 


OX OY OZ 
V+F=[0, 0, 0,)+|xX ¥ =a Be os 


Solution 28.7 
1. curlF = —2cos(x) cos(y)k 


2. curlF = xcos(z)i + ycos(z)j — 2sin(z)k 
Solution 28.8 
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Solution 28.9 


1. In polar coordinates V(r, 0) = In(r), so the contours of V should be circles. 
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Computed by Wolfram|Alpha 

3. 

This is not actually the gradient field - we’ve produced instead the streamlines using the 

"streamplot" function in WolframAlpha. The streamlines are the path that the Neato would 
take if it continuously followed the direction of steepest ascent. 


4. It would move toward the origin (gradient descent)! 


Solution 28.10 
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Computed by Wolfram|Alpha 
2. 


3. It would move away from (1,2) and eventually find its way to (0,0). 


Solution 28.11 








1. V(a,y) = In V2? + y? — Inv (a — 1)? + y? — Inv (a — 2)? + (y — 3)? 
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Computed by Wolfram|Alpha 


4. It would move away from (1, 2) and eventually find its way to (0,0). 


Chapter 29 


Robo Homework 7: Potential Fields 
and The Gauntlet 





Schedule 
26.0 Potential Fields: . 2.2.66: 6 ce bd ea ee ee ae ee ee 273 
29.2 Applying these ideas to the Gauntlet - Conceptual... ................ 275 
29.3 Optional Extension: RANSAC .. 2... ee ee 276 
29.4 Optional Extension: the Best-Fit Circle ... 0... 2... 0... 0.2.00. 0 2 ee eee 276 





29.1 Potential Fields 


This week you worked on the concepts of scalar fields and vector fields, and you met the concept of "sources" 
and "sinks" of potential fields. Let’s start by clarifying and synthesising some of this work. Recall that a sink 
at the origin is represented by the potential field 


V(a,y) = InV/2? + y? 


which has the following gradient vector field 


w yo 


We= i+ 
ety? vty 





Exercise 29.1 


1. What is the potential field and gradient vector field for a source at the origin? 


2. What is the potential field and gradient vector field for a sink at the location (a,b). 


Exercise 29.2 


1. Sketch the contour levels for a sink at the origin. 





276 


CHAPTER 29. ROBO HOMEWORK 7: POTENTIAL FIELDS AND THE GAUNTLET 277 


. Read the following MATLAB script and make sure you understand the purpose of every 
statement. Then implement it and compare the result with your sketch. 


[x, y]=meshgrid(-3:0.05:3,-3:0.05:3); 
v = log(sqrt(x.42+y.42)); 
contour(x,y,v,'k', 'ShowText', 'On') 
axis equal 

. Write down the potential field for a source at (1, 2). 


. Sketch the contour levels with a sink at the origin and a source at (1,2). 


. Modify the MATLAB script above to confirm your prediction. 


Exercise 29.3 
1. Sketch the gradient vector field for a sink at the origin. 


2. Read the following MATLAB script and make sure you understand the purpose of every 
statement. Then implement it and compare the result with your sketch. 


[x, y]=meshgrid(-3:0.3:3,-3:0.3:3); 
fx = x./(K.A2+y.42); 

fy = y./(%.A2+y.42); 
quiver(x,y,fx, fy) 

axis equal 


3. Write down the gradient vector field for a source at (1, 2). 


4. Sketch the gradient vector field with a sink at the origin and a source at (1, 2). 


5. Modify the MATLAB script above to confirm your prediction. 


Exercise 29.4 


1. Consider a source “line” sitting on the x-axis between x=-1 and x=+1. Sketch the contours of 
the potential field and the gradient vector field. (Hint: Start really far away, and then move in 
closer to the line.) 


. Read the following MATLAB script and make sure you understand the purpose of every 
statement. Then implement it and compare the result with the contours on your sketch. 


[x, y]=meshgrid(-3:0.05:3,-3:0.05:3); 
Vie an OE: 
for a = -1:0.01:1 
v =v - log(sqrt((x-a).42 + y.42)); 
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end 
contour(x,y,v,'k', 'ShowText', 'On') 
axis equal 


. How would you compute and visualize the gradient vector field for this line source? Go ahead 
and do so. 


4. How would you change the source to a line from x=-2 to x=-1 at y=2? Go ahead and do so. 


Exercise 29.5 


1. Consider a source “circle” of radius 1 centered at the origin. Sketch the contours of the potential 
field and the gradient vector field (outside of the circle). 


. Read the following MATLAB script and make sure you understand the purpose of every 
statement. Then implement it and compare the result with the contours on your sketch. 


[x, y]=meshgrid(-3:0.01:3,-3:0.01:3); 
Wan Ok: 
for theta = 0:0.1:2*pi 
a = cos(theta) ; 
b sin(theta) ; 
Vv v - log (sqrt((x-a).%2 + (y-b).42)); 


contour(x,y,v,'k', 'ShowText', 'On') 
axis equal 


. How would you compute and visualize the gradient vector field for this circle source? Go 
ahead and do so. 


. How would you edit the script to make the source be a circle of radius 2, centered at (-1,2)? Go 
ahead and do so. 


Exercise 29.6 


How would you define a general source (or sink) curve in the plane? Hint: use parametric equations! 
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29.2 Applying these ideas to the Gauntlet - Conceptual 


Exercise 29.7 


Now that you’ve thought about potential fields for sources and sinks (including lines and circles), 
we'd like you to conceptually think about how this might apply to helping a NEATO navigate the 
Gauntlet. 


. Review the Gauntlet—it can be found in Chapter 30. 


. Thinking just about the walls, sketch the potential field and the gradient vector field if we 
treat the walls as line sources. 


. Thinking just about the obstacles, sketch the potential field and the gradient vector field if we 
treat the obstacles as being composed of line sources. 


. Thinking just about the barrel of benevolence, sketch the potential field and the gradient vector 
field if we treat the BoB as a circle sink. 


. Can you imagine how you would add all of the above sketches to build a sketch for the entire 
Gauntlet? 


. How would you use the computational tools from the earlier exercises to determine the actual 
potential field and gradient vector field for the Gauntlet? 





29.3 Optional Extension: RANSAC 


We did not have time this year to investigate the RANSAC algorithm in class, but it is needed if you want to 
tackle level 2 or 3 of the Gauntlet challenge. We have included material about the RANSAC algorithm in 
Chapter 31, and we will also be briefly discussing the algorithm during class next week. If you would like to 
do level z2 or 3 of the Gauntlet challenge, we recommend workign through these RANSAC exercises. 


29.4 Optional Extension: the Best-Fit Circle 


If you plan to identify and locate the Bucket of Benevolence in The Gauntlet challenge, you will need to be 
able to find and fit a circle. The steps outlined in chapter 32 will guide you through the process of creating a 
circle-fitting algorithm of your own design. 


CHAPTER 29. ROBO HOMEWORK 7: POTENTIAL FIELDS AND THE GAUNTLET 280 


Solution 29.1 
1. Include a negative in front to turn a sink into a source. 
2. The potential field for a sink at (a,b) is 
V(a,y) = In V (a — a)? + (y — 6)? 


which has the following gradient vector field 





w—a 
VV= i+ 
(ea? +(y—bP 





Solution 29.2 
1. Circles surrounding the origin. 


2. Zbuild a mesh 
[x, y]=meshgrid(-3:0.05:3,-3:0.05:3); 
”define the potential at all mesh points 
v = log(sqrt(x.42+y.42)); 
*plot contours with levels marked 
contour(x,y,v,'k', 'ShowText', 'On') 
%so that circles look like circles 
axis equal 





V(a,y) = —In (a — 1)? + (y - 2)? 


4. Circles when close to the sink or source. As you move away there are still circles but their 
center shifts. There is a line of constant potential that bisects the line that connects the sink 
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Solution 29.3 





i) 
T 


T 


fo} 
T 


id 














1. Arrows pointing radially outward. 
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2. %create the mesh, less points so vectors visible 
[x, y]=meshgrid(-3:0.3:3,-3:0.3:3); 
”%define the components of the gradient 
fx = x./(K.A2+y.42); 
fy = y./(%.424+y.42); 
”draw the arrows at the mesh points 
quiver(x,y,fx,fy) 
”%80 Circles look like circles 
axis equal 


x—1 m y—2 
VV = 
(@@—-1?+(-22 (@—-1?+y-2) 





4. Arrows points away from the sink at the origin, and converging on the source at (1,2). 





Solution 29.4 


1. Far away the contours look like circles and the gradient field radiates inward to the source. 
Close to the line the contours have to be squeezed and will look more elliptical, with the 
gradient field radiating inward. 


2. “create a mesh 
[x, y]=meshgrid(-3:0.05:3,-3:0.05:3); 
“initialize the potential to zero 


v = 0; 
%loop through source points from -1 to +1 
for a = -1:0.01:1 
v =v - log(sqrt((x-a).42 + y.42));%add the sources 
end 
%draw the contours 
contour(x,y,v,'k', 'ShowText', 'On') 


%so0 circles look like circles 
axis equal 
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4. We would sum up the gradient field from all of the sources on the line. 


5. We would change the "for loop" as follows: 


-2:0.01:-1 
v - log (sqrt((x-a).%2 + (y-2).42)); 


for a 
Vv 
end 


Solution 29.5 


1. The contours will be circles, but they will decrease more slowly than the case of a single source 
at the origin. The gradient vectors will be radiating inwards. 


2. “create a mesh 
[x, y]=meshgrid(-3:0.01:3,-3:0.01:3); 
*initialize the potential to zero 
v = 0; 
*%loop through angles from 0 to 2 pi 
for theta = 0:0.1:2*pi 
%sources have coordinates (a,b) 


a = cos(theta) ; 
b = sin(theta); 
v =v - log(sqrt((x-a).%2 + (y-b).42)); 


end 

%visualize the contours 
contour(x,y,v,'k', 'ShowText', 'On') 
%make circles look like circles 
axis equal 


3 
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3. We would sum up the gradient field from all the sources on the circle. 
4. We would change the source coordinates as follows 


a 
b 


-14+2.*cos(theta) ; 
+24+2.*sin(theta) ; 


Solution 29.6 


How would you define a general source (or sink) curve in the plane? Hint: use parametric equations! 


Solution 29.7 


Chapter 30 


The Gauntlet 


30.1 Overview 


You have mastered the Bridge of Doom and navigated Flatland. Now you face the most challenging challenge 
you've ever been challenged with. In this final challenge, you will help your robot to dodge through obstacles 
on your way to the ultimate prize — knowledge. 

Throughout this semester, you have applied many quantitative engineering analysis tools. For this 
challenge, you'll use a powerful new sensor (the laser scanner), explore some algorithms for optimization, 
and use the mathematics of potential functions and vector fields. 

If you'd like you can work in a group (up to 3 people total per group) to complete the challenge and the 
write-up. 


? Learning Objectives 


This challenge has varying levels of difficulty. The learning objectives vary based on the level you 
choose. 


1. Fit models of lines and circles to laser scan data (level 2 and 3). 
2. Implement outlier resistant optimization via the RANSAC algorithm (level 2 and 3). 


3. Create suitable potential functions and vector fields to guid a robot to a goal while avoiding 
obstacles (all levels) 


4. Transforming between multiple coordinate systems (all levels) 
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Obstacle 
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Figure 30.1: A top-down view of The Gauntlet. You should write a program to guide the Neato past the 
obstacles (boxes) to the goal (the Barrel of Benevolence). 


30.2 The Challenge 


Your goal is to write a program to pilot your (virtual) Neato through a series of obstacles (concrete barriers 
and boxes). You will detect these obstacles using your robot’s onboard laser scanner, which can detect 
obstacles within a 5m range (see Figure 30.1). 

This final QEA-I challenge has a hierarchy of missions, which get progressively more difficult. For all 
missions, the goal is to gently tap the Barrel of Benevolence (BoB). For all missions, the Neato starts at 
coordinate 0 mi + 0 mj, facing along the +1 direction. 

Here are the conditions for the missions: 


Level 1 You are given the coordinates of the BoB and the obstacle and wall locations (see Figure 30.1). You will 
use these locations to create a potential field and use gradient descent to move your robot through the 
Gauntlet to the BoB. The path can be entirely pre-planned. 


Level 2 You tackle the same challenge as level 1, but you must use the LIDAR to detect and avoid obstacles (ie., 
you should not use the obstacle and wall locations in Figure 30.1, but instead determine them from 
the robot’s sensors). You can plan your entire path based on your initial LIDAR scan or dynamically 
update your path as you go. The location of the BoB is known. To tackle this level of the challenge, 
you will need the RANSAC material in Chapter 31. 


Level 3 You tackle the same challenge as level 2, but you are given the radius of the BoB (see Figure 30.1), but 
not the coordinates (i.e., you must use LIDAR scans to identify and locate the BoB). You can plan your 
entire path based on your initial LIDAR scan or dynamically update your path as you go. To identify 
the BoB, you will need to differentiate the distinctive, circular shape of the goal from the linear shape 
of the obstacles. If you choose this mission, we recommend you look at the circle-fitting extension in 
Chapter 32. 


To achieve whichever mission(s) you choose to accept, you will apply what you have learned about 
potential functions and vector fields. You may also choose to extend any of the above missions by applying 
or creating another goal-seeking/obstacle-avoiding algorithm, not taking the BoB’s radius as an input, or 
trying to reach the target as soon as possible. 
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30.2.1 Loading the Gauntlet 


To start the Gauntlet world, you can use the qeasim script by running the following script in MATLAB. 


qeasim start gauntlet_final 


30.3. Deliverables 


Don’t think of these deliverables as only items to check off, but rather think of them as scaffolding to get 
maximum learning from the task at hand. By creating these intermediate deliverables, you will be able to 
more easily debug your code as well as your understanding of the algorithms you are utilizing. 

Note that all of these deliverables can be done with your group (if you are working with others 
for the challenge). Make sure to clearly specify who is in your group for the challenge on each 
deliverable. Unless otherwise noted, the components are required for all levels of the challenge. 


Mapping and Path Planning (due 5/6, but suggested completion date is 5/3) [6 pts]: We suggest 
that you make significant progress on the math side of this project before class on Monday. Create a document 
with the following plots: 


1. A map of the Gauntlet using LIDAR scan data. Please see details of this map for each level of challenge. 
[2 pts] 

(a) Level 1: The map should be an ensemble of data points from laser scans collected at various 

positions around the Gauntlet and translated/rotated to the global coordinate frame. The points 


from each scan should be shown in a different color, and all walls, obstacles, and the BoB should 
be captured by the scans. The plot should have appropriate labels and units. 


(b) Level 2: A map of the Gauntlet created using laser scan data as above, and with walls and 
obstacles fitted as line segments using your RANSAC algorithm. 


(c) Level 3: A map with fitted lines as above, with the addition of a fit for the BoB. 
2. An equation and a contour (or 3-D) plot of the potential field you developed for the pen. [2 pts] 
(a) Level 1: The position of the walls, obstacles, and BoB can be based on the positions of the 
features shown in Figure 30.1. 
(b) Level 2 and 3: The potential field should be generated based on the locations of obstacles and 
the BoB identified using the laser scans and line/circle fitting algorithms. 
3. A quiver plot of the gradient of your potential field. [1 pt] 
4. A path of gradient descent from the starting point to the BoB. [1 pt] 


These plots should be clearly labeled and readable (decent size fonts!). You will turn these in on 
Canvas through the Mapping and Path Planning assignment. 


Navigating the Gauntlet (due 5/6) [8 pts]: Prepare a video and a brief writeup of your work on this 
challenge. 

Your final writeup should center around critical information and informative figures. It can be as short 
as you want, but it must contain the following components: 


1. A short introduction stating the mission you chose and a brief summary of the strategy you used to 
solve the challenge. You might find it helpful to refer to the decomposition exercise from Week 7. [1 


pt] 


2. Some experimental data that shows, quantitatively, how well your system worked, plus a few sentences 
of explanation. Note: you could make use of the collectDataset_sim.m function for this. 
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(a) The time it took your robot to get to the BoB (for whichever mission you choose) and the distance 
it traveled. [1 pt] 


(b) A plot with: a map of the relevant features of the Gauntlet based on a LIDAR scan (levels 2 and 
3) or the features given in Figure 30.1 (level 1), the intended path of gradient descent, and the 
path your robot took calculated from the wheel encoder data. This should be a legible plot with 
axis labels, a legend, and a caption...the works. [3 pts] 


3. A link to a video of your robot in action. [2 pts] 


In addition to the writeup, you should also turn in your (commented and readable!) code. [1 pt] 


Chapter 31 


Optional Material: The RANSAC 
Algorithm and Finding Lines 





Schedule 
S24 RANSAC [so mites] oie ceed kee weds aa aoe lee Bede ara awe a 285 
iid  iiotivdiinig Byample. s.-s a3 6 eh roa wok kw a Sa Ee ee ae Ge 286 
31.1.2 Robust Optimization and the RANSAC Algorithm .................. 286 
31.2 Coffee Break [10 minutes] ........... 0.0. eee eee ee eee ee 290 
31.3 Converting from Intuition to Pseudocode [45 minutes] ................ 290 
31.4 Implementing Your Algorithm [50 minutes] ...............2.20 000.8 291 





? Learning Objectives 
From LIDAR data, (r, 6), that contains a linear object and outliers, 
« Design the steps for a RANSAC algorithm to find a line in a laser scan. 


« Create an algorithm to sort the data points that fit the line and those that do not. 


Challenge: Find multiple lines using the RANSAC algorithm from a LIDAR data set with multiple linear 
object signals. 


31.1 RANSAC [20 minutes] 


Today we'll be learning a technique for optimization in the presence of outliers. The algorithm is called 
Random Sample Consensus, RANSAC for short, and it has applicability to a wide variety of problems in 
robotics and computer vision. In The Gauntlet™ we'll be using it to find lines in laser scan data even when 
multiple structures are present (e.g., multiple walls, lines and circles). 


288 


CHAPTER 31. OPTIONAL MATERIAL: THE RANSAC ALGORITHM AND FINDING LINES 289 


31.1.1 Motivating Example 
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Figure 31.1: The lines of best fit as computed by linear regression and PCA. Due to the mixed structures in 

the data, the results are very poor. 


Previously, you applied line fitting techniques to four different laser scans. The linear regression method 
worked well in some cases, but it had some clear shortcomings (e.g., when the scan points were oriented 
vertically). The PCA algorithm was able to overcome some of these limitations, however, there were cases 
when even PCA failed. For instance, Figure 31.1 shows the results of applying both linear regression and 
PCA to scan4.mat. Due to the fact that there are outliers (i.e. points that do not lie on the line), both linear 
regression and PCA find lines that do not correspond at all to the line clearly visible in the scan. 

We can conclude from this example that the methods of line fitting that we’ve learned thus far are 
effective yet brittle (ie. they fail when conditions aren’t ideal). Motivated by this observation, today we’ll be 
learning how to use the RANSAC algorithm to filter outliers before applying one of the line fitting methods 
you explored in the overnight. 


31.1.2, Robust Optimization and the RANSAC Algorithm 


The mathematical field of robust optimization provides us with techniques for optimizing functions (such as 
MSE) that are robust in the presence of outliers. Today, you'll explore a very powerful technique for robust 
optimization called Random Sample Consensus (or RANSAC for short). The algorithm works by choosing a 
small subset of data points to fit a model, determining whether or not a significant proportion of the data is 
consistent with the fitted model, and then repeating this process until a satisfactory model is found. For 
instance, let’s suppose we want to find a line in this laser scan. 


Exercise 31.1 


1. Qualitatively, how many unique structures do you see in this laser scan? 
2. Using the Zoom annotation tools, discuss and draw in your "best fit" line(s). 


3. Based on your experience with linear regression and PCA during Day 7, where do you expect 
these algorithms would place a fit line? Go ahead and sketch them as well. 
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The RANSAC algorithm starts by randomly choosing a minimal subset of data points required to define a 
line (which of course is 2). Given these 2 points, we define our candidate line as the line that passes through 
both of those points (this is our “model”). Next, we divide all of the points in our laser scan into two groups. 
The first group, called inliers, consists of points in the laser scan that are sufficiently close to our candidate 
line. The second group of points, called outliers, consists of points in the laser scan that are far from the 
candidate line. We are free to choose the notion of what it means to be close or far from our candidate 
line. Based on our experience in the overnight, the perpendicular distance seems like a reasonable choice 
to measure the closeness of a point to a line (recall that this is what PCA uses). Therefore, we'll use the 
perpendicular distance as a metric for deciding whether a point is an inlier or an outlier. Figure 31.2 shows 
an example of applying this procedure. The inliers are marked in either white (for the two points used to 
make the line) or blue. The inliers are the points that fall within a perpendicular distance d from the line (d 
is a threshold value that you specify to RANSAC). The outliers (those that fall outside of a distance d of the 
line) are marked in red. While the line defined by the two randomly chosen points results in some inliers, 
the number of inliers (4 including the points used to make the line) is perhaps not as large as it could be. 


Exercise 31.2 


1. On Figure 31.2, draw a new best fit line and threshold lines that would optimize the number of 
inliers vs. outliers. Identify which points would serve as the endpoints of this line. 


2. How did you choose your line/endpoints? Discuss possible strategies to accomplish this task. 








Figure 31.2: The white points represent the randomly chosen subset of two points to define the line. 
The solid line passing through them is the resultant line. The two dashed lines correspond to the 
inlier threshold (defined by measuring a specified distance d perpendicularly from the line). The 
points that are inliers are marked in blue and the outliers are red. 
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Figure 31.3: The white points represent the randomly chosen subset of points and to define the line. The 
solid line passing through them is that resultant line. The two dashed lines correspond to the inlier threshold 
(defined by measuring a specified distance d perpendicularly from the line). The points that are inliers are 
marked in blue and the outliers are red. 
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Next, we choose a new random set of 2 points, define the line passing through those points as our 
candidate line, and determine inliers and outliers. If this new candidate line results in more inliers than 
the first one we tried, we save the line for later. We repeat the procedure (choosing two random points, 
determining inliers, and testing to see if the number of inliers is the highest we’ve found so far) n times, 
where n is a parameter that you specify to the RANSAC algorithm. If all goes well, one of these n lines 
results in something like Figure 31.3. For the randomly chosen points shown in the figure, the number of 
inliers is 7 which looks to be about as good as we can do with this scan data. 

As a final consideration, in the case of fitting lines to laser scan data, we want to be able to determine 
not just where the lines are in the scan, but also where the lines begin and end. This is crucial since the lines 
we are finding correspond to things like the beginning and end of walls or obstacles. There are a few ways 
to approach this task, and we'd like you to come up with your own method as part of today’s activities. We 
are certainly here to scaffold this, but wrestling with this a bit will help to build your intuition about the 
geometry of the problem. 


31.2 Coffee Break [10 minutes] 


31.3 Converting from Intuition to Pseudocode [45 minutes] 


Let’s take stock of where we are. You should now have a pretty good idea about how RANSAC works on a 
conceptual level. Next, you'll be working to take this intuition and convert it into pseudocode. 

When writing pseudocode it helps to start by stating your high-level conceptual understanding of how 
to solve the problem, and then, work towards progressively more concrete statements of how to solve the 
problem. Motivated by this idea, here’s a possible procedure you can use with your partner to generate 
pseudocode. 


1. Clear up conceptual misunderstandings: You just read through some text that described the 
RANSAC algorithm. Were there any parts that didn’t make sense at a conceptual level? If so, make 
sure you work through these with your partner. If you can’t figure out one of your questions, let us 
know! We're here to help. 


2. Simulate the algorithm: at the whiteboard, simulate the steps that RANSAC would go through 
to find a line in a laser scan. You can do this through a combination of pictures (like the ones in 
Figure 31.3) and explanatory text (e.g., select points at random). As you go through this process you 
may find that you don’t understand some of the details as well as you thought. This is another chance 
to ask for help from the teaching team. 


3. Write out the major steps: Next, write the sequence of major steps the algorithm should perform. 
By this point your descriptions should be getting more precise (although not necessarily more detailed). 
Deciding how big to make each step is a bit of a balancing act. You want to avoid sequences such as 
“1. Do the thing 2. ??? 3. Profit”, but you certainly don’t want to have a 25 step process. Shoot for 
something on the order of 5-7 steps. Each of these steps can later be subdivided into smaller pieces. 


4. Figure out your functions: the major steps you've defined can be thought of as the functions that 
you will write to implement your algorithm. For instance, you may have come up with a step called 
“compute inliers and oultiers”. The fact that you identified this as a major step for your algorithm 
suggests that making a function that performs this computation is probably a good idea. At the 
whiteboard write out a list of the functions you will create when implementing RANSAC. Make sure 
to describe what each of these functions expects as input, what it will generate as output, and what it 
does. 


5. Write your pseudocode: Next, write pseudocode for each of the functions you’ve identified as well 
as pseudocode that stitches these functions together to implement RANSAC. Your pseudocode should 
be written in natural language (avoid using actual MATLAB syntax in your pseudocode), yet precise 
enough that there is little ambiguity about how it could be translated into actual MATLAB code. To 
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better make this last point, here are two different potential ways to write pseudocode for finding the 
maximum element in a list of values. 


Input: a list of numbers L 
for each number x in the list L 
if x is the highest value so far 
remember x 
return the highest value we found 


This pseudocode has some good properties. It is written in natural language and it specifies the inputs 
of the function. On the negative side there is still a good deal of ambiguity here. How do I test if “x is 
the highest value so far”? How do I “remember x”? Here’s a version that improves the pseudocode in 
this respect. 


Input: a list of numbers L 
initialize a variable called maxval to the value negative infinity 
for each number x in the list L 
if x is greater than maxval 
assign the value of x to maxval 
return the variable maxval 


This new version of the pseudocode can be unambiguously translated to a computer program. 


Exercise 31.3 


Write pseudocode to implement the algorithm described in Section 31.1.2. Your pseudocode should be 
capable of going from a polar coordinate representation of a laser scan to the endpoints, in Cartesian 
space, of a line segment that corresponds to a line in the laser scan. 





31.4 Implementing Your Algorithm [50 minutes] 


In this section you'll be translating your pseudo-code into MATLAB. 


Exercise 31.4 


Implement RANSAC using the pseudocode you wrote in the previous exercise. Test your algorithm 
on the data in scan4.mat. As a suggestion, you should define a top-level function called robustLineFit 
that takes as input a polar representation of the laser scan, the threshold d to use to determine 
whether a scan point is an inlier, and n the number of random lines to try. Once you’ve implemented 
your algorithm, experiment with d and n to understand their effect. 

Debugging and implementation tips: 


1. Visualize, visualize, visualize. For instance, make sure your procedure for determining inliers 
is correct, you should plot the fitted line, the inliers, and the outliers. Make sure to use different 
colors to plot the inliers versus outliers. 


. Develop incrementally. Build your program bit by bit. Experiment in the command window 
before writing code in your MATLAB script. 


. Set breakpoints. This can be accomplished by either using the keyboard statement or by 
creating a stop sign by clicking to the left of the line of MATLAB code. These breakpoints 
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are particularly useful in two situations. The first situation is obvious - when attempting 
to debug code. The second situation is when you are about to write an intricate section of 
code. In this case, set the breakpoint where the code will eventually go. Run your existing (but 


incomplete) code. When MATLAB stops at the break point, you can prototype your solution 
in the command window before adding it into your script. 


CO 


Recommended Extension: If all has gone well, you should have a beautiful line segment fit to the data in 
scan4.mat. Unfortunately for you, The Gauntlet™ is a bit more complicated than the Chamber of Emptiness™. 
Next you'll be updating your code to find multiple lines. 





Exercise 31.5 


First, write pseudocode to find multiple lines in a laser scan. When doing this you should HEAVILY 
leverage what you did in exercise 3. For instance, if you have a function called robustLineFit which 
takes a scan and computes the best fitting line segment, you can call it repeatedly to find multiple 
lines. Specifically, each time you call your robustLineFit code, you'll determine a line segment in scan. 
After determining a line segment, you should remove the inlier points for that line segment from the 
scan data. By removing these scan points each subsequent line you find will consist of points that 
were outliers with respect to the lines you previously found. Implement your approach and try it on 
the data stored in playpensample.mat. 


Debugging and implementation tips: 


1. In order to write this in a sane fashion, your functions will need to be solid. Make sure you are 
confident in each function before building on it. 


2. You may consider modifying your robustLineFit to return multiple pieces of information 
(instead of just the line segment of best fit). For instance, if you return the inlier points and 
outliers points separately your life will be a lot easier. If you’re not familiar with returning 
multiple outputs from a MATLAB function, see this page. 
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Challenge Problem: If all went well you should now be finding all the walls in a fairly complex laser 
scan. You may have noticed some warts in the lines that your code finds. The biggest issue is that the line 
segments that are found sometimes have large gaps in them. This causes you to find lines that span across 
gaps in the environment. Later in the challenge you'll be using these line segments to determine a path 
through the environment, so it is important that the gaps are not covered over by spurious lines. 


Exercise 31.6 


Modify your robustLineFit code to avoid fitting line segments with large gaps. To do this, define 
a procedure for computing the largest gap in a candidate line segment. Start out by working on 
the board to build intuition, and only when you have a good sense of how to solve the problem, 
implement things in MATLAB. 
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Solution 31.4 


An example solution using the RANSAC algorithm with d=o.1m and n=30 iterations is shown in 
Figure 31.4. A heavily commented, working RANSAC function is here. 





RANSAC with d=0.1 and n=30 
0.6 T T : T 
QO sInliers 
0.4 QO Outliers 
Best Fit 






















Figure 31.4: Best fit to Scanqg using RANSAC with d=o.1m and n=30. 


Solution 31.5 


A solution is here. 


Solution 31.6 


In the solution here, gaps are identified using the code: 


”we also want to check that there are no big gaps in our walls. To do 
”this, we are first taking the distance of each inlier away from an 
”endpoint (diffs) and projecting onto the best fit direction. We then 
”sort these from smallest to largest and take difference to find the 
”spacing between adjacent points. We then identify the maximum gap. 

biggestGap = max(diff(sort(diffs(inliers,:)*v/norm(v)))); 


Chapter 32 


Optional Material: the Best-Fit Circle 


If you plan to identify and locate the Bucket of Benevolence in The Gauntlet challenge, you will need to 
be able to find and fit a circle. These steps will guide you through the process of creating a circle-fitting 
algorithm of your own design. 


Exercise 32.1 


Assume that you have collected a set of N data points («;, y;). There are multiple approaches to 
fitting a circle to this data, but we would like you to utilize the tools you have learned in QEA this 
semester, specifically linear regression and the RANSAC algorithm. 


1. What are the different ways of describing a circle? Think about explicit, implicit, and parametric 
representations. Don’t forget that there are various ways of describing a circle using each of 
these representations. 


. We would like you to set up the circle fitting problem using linear regression techniques from 
linear algebra i.e. an over-constrained system of linear equations where A*w = b. Choose one 
of the circle equations you identified and write out the A, w, and b matrices. 


. How would you solve this system? 


. Now imagine that you wanted to fit a circle using something more like a RANSAC approach. 
Describe the algorithm you would use, assuming that you knew the radius of the circle your 
were fitting (a la BoB). How many points would you need to select to fit each candidate circle? 


. What if you didn’t know the radius? How would you have to modify your RANSAC approach? 


Exercise 32.2 


At this point, you have a couple of approaches in mind, and you’ve thought through the details of 
each. Let’s test your ideas now by implementing in MATLAB. 


1. Write pseudocode for finding the best-fit circle using one of your methods. 


2. Generate some test points that lie on a circle of radius 2. Rather than generating points on the 
entire circle, let’s generate points on an arc of 120 degrees to mimic the extent of the data we 
might get from the NEATO. 
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3. Test your methods on this data. How good is your best-fit circle? Do your results depend on 
which method you use, or how you initialize the method? 


. Now incorporate a little noise into your test data set by perturbing the radius of each of your 
data points (consider using the MATLAB function randn to do this). How does this affect your 
results? Make sure to try your code a couple of times to get a representative picture of how 
well it works on different noisy data samples. 


. Now implement the pseudocode you generated above into a working RANSAC-style circle 
fitting algorithm in Matlab. Test your code on the file playpensample.mat which has one 
instance of the BOB with r=0.1329m. 





